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I. INTRODUCTION 


A. OVERVIEW OF AN INERTIAL NAVIGATION SYSTEM (I.N.S.) 

A conventional gimballed inertial measurement unit 
consists of a platform suspended by a gimbal structure that 
allows three degrees of rotational freedom [Ref. 1,2,7]. 

The outermost gimbal can be attached to the body of some 
Memeere and allow that vehicle to undergo any change in 

angular orientation while maintaining the platform fixed 
With respect to some desired coordinate frame. 

Gyros mounted on the platform sense the angular rate of 
the platform with respect to inertial space and their 
Semeomes are sent through electronics to the torque motors on 
tne gimballed structure, commanding them to maintain a 
desired platform orientation regardless of the orientation 
of the outermost gimbal which remains fixed to the body. 

Feedback control loops that keep the gyro outputs 
nulled, will maintain at the same time the platform fixed 
with respect to the inertial space. These feedback loops 
ere Merch that, in practice, the platform orientation is kept 
essentially stable regardless of the most violent vehicle 
maneuvering. Additional (computed) inputs can be added to 


the above feedback loops to maintain some other orientation, 
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such as North-East-Down, corresponding to the current 
location of the vehicle. 

Accelerometers mounted on the platform can provide the 
vehicle's acceleration with respect to the Known set of 
reference coordinates. In fact, specific force is measured 
bv the accelerometers so that local gravity must be computed 
and appropriately subtracted from these sensor outputs 
in order to ootain a measurement of actual venicle 
acceleration. 

The vehicle's velocity and position are obtained by 
integration of the above acceleration measurement signals. 
Attitude information as well as translational information is 
provided by the I.N.S.. A typical gimballed inertial 


Measurement unit [Ref. 2] is shown in Fiz. 1. 


EeeeovVERVigw OF THE C.P.S. 

idee Global Positioning System (GPS) is a satellite 
navigation system currently under development. It will 
SOmorot, according to today's available information, of 18 
Satellites placed in groups of six in each of three 
different circular, 12 hour orbits at an altitude of 10,900 
N.M. inclined 63° to the equator and spaced 120° apart. 

The satellites will broadcast pseudo-random noise codes 
(codes P and C/A) and ephemerides on two L-band signals to 
uSers worldwide in such a way that each satellite signal can 


be distinguished from the others by the user. A user will 
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Figure 1. Typical Gimbaled Inertial Measurement Unit [Ref. 2] 
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be equipped with a small receiver (G.P.S. user equipment) 
which measures the pseudo-range and pseudo-range rate from 
the user to the satellite. 

By means of a correlator-detector the time (phase) shift 
between each satellite signal and the user's unsynchronized 
clock will be measured in his receiver to provide an 
maameation of the range from the satellite to the user. 
Mealy, 2our satellite signals may be received simul- 
taneously by the user equipment. 

The phases of the NAVSTAR/G.P.S. system are shown in 


Pewee 6h dT Ref. 86). 


ee... OPTIMAL AIDING 

Once we nave available a typical inertial measurement 
Gigeeeeor tne inertial navigation system as a whole, tne 
@iiemri10n naturally arises: why does this system requires 
optimal aiding by other navigational sensors? The answer to 
tnimemaquestion is’ given in Ref. 2 and here we present the 
GOneeots only. 

Due to the tight control loops supporting the I.N.5S. 
very good high frequency information is provided. However, 
because of gyro characteristics, the system drifts at a slow 
rate so that the long term (low frequency content) of the 
@ava 7S poor. it is well known that all inertial systems 
have position errors that grow slowly with time and these 


errors are unbounded. 
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As opposed to an I.N.S. which can be classed as a "one 
nautical mile per hour system" due to the associated 
position error, most other navigation aids provide very good 
low frequency information but subject to considerable high 
frequency noise, due to instrument noise, atmospheric 
effects, antenna oscillation, unlevel ground effects and so 
orath . 

One would want to combine the availaole information from 
an I.N.S. and other external sources in an optimal manner if 
possible so that one can obtain efficient estimates of 
navigation parameters that are best with respect to some 
Womseedetined criterion. Such an optimal approach is 
provided by the Kalman filter approach which is briefly 


discussed next. 


D. KALMAN FILTER 

The Kalman filter is an optimal recursive data process- 
ing algorithm located in the on-board computer or central 
processor that uses Sampled data with sample period on the 
order of 5-60 seconds, to maintain estimates of approxi- 
mately 60-70 state variables. The filter combines all 
available measurement data with prior knowledge of the 
System and measuring devices to produce an eStimate of the 
system states in such a manner as to statistically minimize 
the resulting errors. In more easily understood terms the 


filter, or computer program, uses the statistical 
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Smaieadeteristles OL the errors in poth the inertial naviga- 
tion components and the external information providing the 
best eStimate possibdle, subject to certain modeling 
assumptions. 

The filter will act to optimize the attitude, position, 
and velocity information accuracy by weighting each data 
source heavily in the frequency ranges where it provides 
more accurate information, and suppressing it in the region 
wnere it is less accurate. The inertial system provides 
good high frequency information but it drifts slowly and 
therefore exhibits poor low frequency performance. On the 
Seger Mand, the external aids” (Such as G.P.S.) generally 
exhibit good low frequency information but are subject to 
nigh frequency noise. Therefore, the filter will use tne 
B@ca low frequency external (G.P.S.) information to damp out 
the slowly growing errors in the inertial system. 

1. Type of Filter Implementation 

There are two very impcertant aspects of implemen- 
Varren Of a Kalman filter in conjunction with an inertial 
system [Ref. 2]. 

a) Total state space (direct) versus error state 
space (indirect) formulation, and 

b) Feedforward versus feedback mechanizations. 
In the indirect formulation the errors in the I.N.5. 
indicated position and velocity are among the estimated 


variables and each measurement presented to the filter 1s 
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the difference between the I.N.S. and the external source 
(G.P.S.) data. The I.N.S. itself follows the high frequency 
motions of the vehicle very accurately, and there is no need 
to model these dynamics explicitly in the filter but the 
dynamics upon which the filter is based is a set of inertial 
system error propagation equations, which are relatively 
Well developed, well behaved, low frequency, and very 
adequately represented as linear [Ref. 2, pp. 296]. 

The indirect feedback configuration is considered 
where the Kalman filter generates the estimates of tne 
Pirmeors Of the I.N.S. and feeds back these errors to the 
ime. tO Correct it. By this configuration we use the two 
majOr advantages. First that the I.N.S. errors are not 
allowed to grow unchecked and the adequacy of a linear model 
ls enhanced. Second is the fact that many of the predicted 
error states which at next time sample time are zero, need 
not be computed explicitly. 

The indirect feedback configuration of the Kalman 
@ebter els’ shown in Figure 3. In Ref. 2 there iseexplicitly 
documented the discussion of the Kalman filter configura- 
tions and mechanizations with their advantages and more 
comments. 

2. Assumptions 
The Kalman filter can be shown to be the best filter 


of any possible form based on the following three 
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assumptions: a linear system, white noise drivers, and the 
Gaussian distribution of noise. 

Although the system itself may be nonlinear, 
formulation of an approximate linear error state space model 
makes linear analysis possible. The justification for the 
meme model is based on two points. For the aided I.N.5S. 
case the use of linear error state space models yields a 
very adequate representation. The techniques of linear 
system analysis are also well developed and better 
understood than those of nonlinear analysis. 

The white noise assumption implies that the noise 
is not correlated in time and also has equal power at all 
frequencies. If, in fact, a time correlated noise is 
required to adequately model the system, it can be produced 
OY passing white noise through a linear snaping filter. Ine 
system can then be modeled with an augmented state variable 
as a linear system driven by white noise. 

Galissieaness pertains to the distribution of 
amplitudes of the noise and implies that at any single point 
in time the probability density function of the amplitude 
takes on the shape of a normal bell-shaped curve. The 
assumption of Gaussian noise amplitude is justified by tne 
fact that the system or measurement noise is typically 
caused by a number of sources. It can be shown 


mathematically that when a number of independent random 
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variables are added tne resultant effect is very nearly a 
Gaussian probability density even though the individual 
densities are not Gaussian [Ref. 9]. 

Under the above mentioned assumptions of a purely 
white Gaussian noise, the first two moments specify the 
entire shape of the density describing the nolse, and the 
mathematics of the problem are greatly simplified. 

In Appendix 4A, a simple example of a Kalman filter 
@pomecation to a radar position-aided I.N.S. is given in 
order to make easier the understanding of Kalman filter 
operation. 

Prd! bien Information about the G.P.S. satellites’ 


geometry and their observabdility is given in Appendix B. 
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Ti. KALMAN FILTER EQUATIONS 


A. GENERAL 

The design of a Kalman filter and especially the 
integrated I.N.S. Kalman filter design requires extensive 
computer simulation. This chapter of the work is a 
presentation of the equations which are required not only 
for the mechanization of the filter but also those which are 
necessary to simulate the dynamics of any user Cal rt eimar c., 
missile). 

fies principal tool used forthe solution of this 
specific and other similar problems is the very common 
mremnod of covariance analysis. It is Known that the 
covariance is a measure of the uncertainty in the knowledge 
of the true values of the state vector components. In this 
work, aS the covariance matrix is concerned, the off 
diagonal terms are assumed to be zero initially and initial 
conditions on the diagonal elements are arbitrarily taken. 
The covariance matrix of both the system and the filter are 
propagated forward in time by numerical integration 
techniques. 

The adjustment of the values of the state variables, to 
those of the best estimate obtained witn the Kalman filter, 


is achieved when a control is applied to the system after 
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the specified update time is reached and the best estimates 
of the states have been determined. The square root of the 
individual diagonal elements of the system covariance matrix 
(RMS values) are plotted as a function of time to provide 
the performance of the filter. For this study the plots are 
also utilized to determine the error contribution associated 
femeecach modeled error source. Furthermore, the error 
Statistics are propagated which means tnat the standard 
deviation of the noise value is supplied whenever a noise is 
required. 

One attribute of covariance analysis is, that under tne 
assumptions stated in Chapter One, i.e., the linearity and 
White Gaussian noise, the covariance is independent of the 
actual measurement values and can be computed through 
generating a sample sequence or measurements. aAnd as a 
matter of fact this method is easier to handle and work with 


than the corresponding Monte Carlo type simulation. 


Bee oto! eM MODEL EQUATIONS 

The differential equations that describe how the 
inertial navigator errors propagate with time are the basic 
equations used in this process. These equations are 
formulated in a set of first order, linear differential 
equations, driven by white Gaussian noise for the reasons 


described previously in this work. 
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Linear measurements corrupted also by white Gaussian 
noise are made upon the actual system variables. [It is 
furthermore assumed that the equations which represent a 
detailed model of the system are of the form: 

Eeaa ets * “sYs (1) 


where 


1S an ny vector denoting the true state 
Fis ann, x n, matrix of system dynamics 


Gos an n, xX m, matrix of gains 


w, is an m, vector of white noise inputs witn the 


cNaracteristics of zero mean and variance: 


r Q5(i) for i= j 
ECtwCi)w(j)°] = (2) 
- 0 for i# j 


where the indices i and j are instants in time. 


The observations which are obtained from external 
references and in our case of study from the G.P.S. can be 
described by the following linear measurement vector 


equation: 


Baa ies, * ie 


2 





EI a 


where: 


Ae 1s a q vector of measurements 


H is a qx n, matrix of measurements 


‘- 1S a q vector of white noise inputs with the 


@meracteristics of zero mean and variance: 


il 
C25 


T R41) ove Sl 
meer y(j) j = (4) 
0 iS Gee 
A further assumption for the study is that the system noise 


Ww and the measurement noise v are uncorrelated for all time, 


Tes ; 
Elw(i)v(j)i]*= 0 HOt ail | tad (5) 


eee cieR EQUATIONS 

The equations discussed above are assumed to be a 
complete and accurate mathematical description of the G.P.S. 
aided inertial navigation system dynamics and measurement 
equations for the purpose of simulation. MThey also 
constitute a set of equations which would be utilized in the 
@esven of a fully optimal Kalman filter. 

In our case of study as also in general a suboptimal or 
reduced order filter design is obtained by reducing the 
dimension of the state vector due to the computational 


burden of the fully optimal filter. The states that are 
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eliminated are those that affect the accuracy the least of 
the mathematical description of the aided-I.N.S. The 
designed suboptimal filter can be implemented with the on- 
poerd computer (aircraft or missile). 

The equations which describe the suboptimal filter are 


eoeeene tom: 


ro 
an en Sele 

where 

Xp iS an N5 Vee vot 

Fp is an Ny X No Mauelx of Milter dynamics 


f=. 2s an A> x Ms, Mewes Of gains 


Wp Poran m yeecvor of white noise inputs witn the 


Siaisaecveristics of wero mean and variance: 


T Qe(i) Per ava) 3 
Bae tie J) ) = ; F cipal (0) 
Cr j 


The equation for the filter measurement is: 
& ¢ = HX ¢ ~ Ve (7) 
where: 


Ze is  q vee€tor 
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Hp woo | xX Gq matrix of measurements 


Ve is a q vector of white noise inputs with the 


characteristics of zero mean and variance: 


T R (i) OG r=.) 
Elvp(idve(9) ae (8) 
0 for ae 2] 


The filter prooagation and update equations based on tne 


above models are then given below. 


At measurement times (update): 


Y 2 a ae es il - | \ 
Ke = Pe do LH oP 5 do a Re (9) 
P = P = Kea? » 10.) 
ee | ee oo (11) 
ee oe PSE 
and between measurements (extrapolate): 

Xe Ss F eke C12) 
: T sy 

Pe = F Pe + P oF p + GpQeGp (13) 


where: 
Ke is an n, vector denoting the best estimate 
Pe is the covariance matrix of the filter 


Ke is the matrix of Kalman gains 
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Z, is a q vector of the actual values of the 


measurements taken 


Powe script, indicates the time instant just after 


update 


eeouperscript indicates the time instant just prior 


to update 


T superscript denotes the transpose matrix or vector 


superscripted. 


tiie frlver subtracts from the actual taken measurement 
Z, tne best prediction of its value before tne actual 
measurement is taken, i.e., the value of H.%,. This 
difference is then passed through an optimal weighting 
matrix K, and used to correct Re the pest prediction of 
the state at the time instant before the measurement 15 
taken. This process gives the best estimate after update. 
This estimate is propagated to the time of the next 
measurement sample according to equations (12) and (13). 

The above recursive relationships are solved based on 


initial conditions of an assumed Gaussian density which 


describe the a-priori knowledge of the state as: 


Paco) = & (14) 


O 


TY 
"U 


and P(0) 
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The Kalman filter conditioned on the actual measurements 
taken, propagates the conditioned probability density of the 
desired states. The probability density function of a 
Gaussian noise amplitude takes on the shape of a normal 
bell-shaped curve. The assumption of Gaussian noise 
Smmbitude is well justified by the fact that a system or 
measurement noise is typically caused by a number of small 
sources and according to the Central Limit Theorem it can be 
shown mathematically that wnen a number of random variaoles 
are added together, the summation is a random variable whose 
density is nearly a Gaussian probability density, regardless 
Of the Shape of the densities of the individual random 
Variables. Furthermore, the use of Gaussian densities makes 
the mathematics easier to handle and tractable. it is Known 
that a Gaussian density is completely determined by its 
pemsoeeand Second order statistics, i.e., the mean and the 
Variance. Thus, the Kalman filter, which propagates the 
fitesc and second order statistics, includes all information 
contained in the conditional probability density mentioned 
above [Ref. 2: pp. 3-9]. 

The mean of a density function or its expectation uw, is 


defined as 


E(x] =u - f KE ( idx (16) 


a= OO 


by) 





and it is interpreted as the weighted average of the values 
Seeeeusing the provability density function f(x) as the 
Weighted function. All the Gaussian white noise inputs in 
this study are assumed to have zero mean. 

The variance of a density function or the square of the 


Standard deviation 9, is defined as: 
2 2 
Weagiex| = o = f aan ws i dx pay ae 


and it is interpreted as the weighted average of the values 
of (x =- wat taus, 3° is a measure of the density spread and 
a direct measure of the uncertainty siace the larger o is, 
the broader the probability peak is, spreading the proba- 
Diselcy weight over a larger range of x values. For the 
Sample of Gaussian density, 68.3% of the probability weignt 
Me concvained within the band of o units to eacn side of the 
mean u, which represents the area under the normal bell- 
snaped curve between the values of -o and +o and 95.4% of 
the probability weight is contained between the values of 
-20 and +20. Since in this study vectors are used instead 
of scalars, the above equations (16) and (17) which give the 
first and second order statistics respectively for the 
scalar case, must be extended for the vector case as 


follows: 
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ELx] =u = J J xf(x)dx,---dx, (18) 
n 
Sovix} = P = J J (x - Ux - iy OCD) Geos ache Gicy 
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Tlie ete eS ROR ANALY SL 


A. GENERAL 

Qne general approach to determine the navigation error 
caused by individual sources of error is to simulate the 
inertial-navization-system noniinear equations and sources 
of error and compare tne navigation outputs witn tne 
Simulated true position--the difference being the navigation 
error. However, this is not the approach used here. 
Assuming that tne position errors are small compared witn 
earth radius, that the velocity errors are small compared 
With orbital velocity, and that tne alignment errors are 
Small compared with 1 radian (or 3437 arc-min) it can oe 
demonstrated that the propagation of errors in an inertial 
navigation system is very accurately governed by a set of 
corresponding linear differential equations. Therefore, 
most inertial-navigation-system error analyses are conducted 
working directly with a set of linear error differential 
equations. 

Sets of error equations have been developed for various 
mim. COucteurations in the context of a particular 
application. As a consequence, many sets of I.N.S. error 


equations have been developed for the various broad classes 
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of mechanization such as local level, space stabilized, 
wander azimuth, free azimuth, strapdown, etc. 

The choice of navigation error variables for analysis 
has often followed from the coordinate system used in the 
navigation equations or that implied by the physical I.N.5S. 
platform orientation. Regardless of the differences in the 
Sets Of equations the fact is that I.N.S. error propagation 
is to a large extent, completely independent of system 
mechanization. Britting {Ref. 2] has shown tnat the basic 
error differential equations for any I.N.S. may be written 
in standard coordinates, regardless of the physical 
mechanization or internal navigation variables. Furtner- 
more, the unforced (homogeneous) portion of these 
Memmercitial equations is, under certain very broad 
Bemeclons, identical for any arditrarily configured 
Gemreestrial I.N.5. 

Tne error equations presented in this chapter follow tne 
philosophy of (Ref. 2] including the choice of north-slaved 
coordinates for the error variables and the identification 
of the unforced (homogeneous) portion of the differential 
equations that is independent of system mechanization. Two 
of the differences that are noticeable are: 

1) The error equations are written as a system of nine 
first order equations (and further on reduced to seven) 


rather than three second order plus three first order 
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Paquarlows. iiIWwe first-order form is the state space repre- 
sentation of the error equations used in modern estimation 
theory. 

2) The form of altitude compensation assumed in 
fRef. 2) is not found in most inertial navigators. Gravity 
1S assumed computed as a function of the inertial system 


indicated position. 


feo RAL T.N.S. ASSUMPTIONS 

The assumptions pertaining to the general error 
differential equations are broad enough to encompass all of 
Maewimportant I.N.S. configurations (Ref. 2]. 

1) Three accelerometers are available to measure the 
specific force vector. The equations for a two-accelero- 
meter local level system are tne same provided tne inervial- 
altitude and vertical-velocity equations are deleted. 

2) The accelerometers are mounted on a platform whose 
angular velocity is either controlled (as with gyro- 
Stabilized gimbaled platforms) or is measured (as with the 
strapdown systems). 

3) The system's indicated velocity vector and three- 
dimensional indicated position are obtained by integration 
of the gravity field compensated specific force measure- 
ments, using a correct set of differential equations. 

4) A model of the earth's gravity field is used to 
calculate the gravity vector as a function of the system- 


e q * e d s 
indicated saositio: 
J eG | Oars we DOS1L C1001 e 
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5) External altitude information and other navigation 
measurements may be used to update the inertial-navigation- 
system indicated position, velocity, and attitude. 

6) A computer is availabe to process the navigation 
information and the computation errors are either negligible 
or may be treated aS equivalent instrument uncertainties. 

ion Becnethe mechanical coordinate frame (the frame 
tracked by the platform) and the computation frame (tae 
frame to which tne specific force measurements are 
transformed for velocity and position integration) are 


aeowrerar y. 


Pree CAL=LEVEL TERRESTRIAL NAVIGATOR 

Many inertiai navigators do use 2 local-level coordinazve 
Byeenm tor the yelocity and position integration. The 
local-level terrestrial navigation system physically instru- 
ments the local geographic coordinate frame. The platforn 
axes are commanded into alignment with the local north-east- 
down coordinate system. 

The local-level terrestrial system is undoubtedly the 
most successfuly of all inertial-navigation-system configur- 
ations. The class of local-level systems today constitutes 
the majority of operational inertial navigations systems. 
Since this system is described in detail in [Ref. 2] here 


are listed some of its advantages: 


43 





1) The computation of gravity components is greatly 
Simplified. In fact some navigators use zero for both 
horizontal components of gravity. 

2) Some inertial navigators have no vertical accelero- 
meter (this is the case in the present study) and do not 
mechanize a vertical channel. The norizontal velocity and 
position equations of a local-level set are appropriate for 
such a navigator. 

3) Tne well-known altitude and vertical velocity 
instability of a pure inertial navigator must be stabilized 
Dy means of an external altitude reference. But a local- 
level set of variables includes altitude and vertical 
velocity explicitly. The altitude stabilization equations 
tnerefore can be simplified. 

foe bae calemlations requimed to provide mavizgation 
outputs and displays in geographic coordinates are 


Slmplified. 


Pee, twO ACCELEROMETER LOCAL-LEVEL SYSTEM 

Many inertial navigators nave only two accelerometers 
after the vertical accelerometer has been eliminated. The 
system is composed of a three axis inertial platform, two 
accelerometers which are nominally orthogonally mounted in 
pase inserumencted Gast and north directions and a computer 
wnich performs the necessary navigational computations 


[Ref. 2]. 
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The north and east gyros are respectively connected with 
the PeenuneNted north and east accelerometers at the signal 
level and the gyros are torqued at a rate proportional to 
the vehicle's longitude and latitude rates so that the 
platform can maintain its axes aligned with geographic axes 
since the vehicle carrying the navigation system is assumed 
to move freely over and above the eartn. The accelerometer 
outputs provide these required torquing signals which muse 
ye sO compensated that gyro command can be obtained as a 
Memetion of only the north and east velocity rates. 

peem a tLwo-accelerometer local-level I.N.S. has seven 
peice variables: two of position, two of velocity, and 
three of platform alignment. 

1. Error Model equations 

The general model of local-level inertial navigation 


systems is given by the following matrix equations: 
125 Mere (20) 


== 


where 


i= s¥evem Characteristic matrix, same for all I-.N.5. 


configurations 
m= =Orclne weetor of inertial system .errors 
ib 
or qg = [4y, Ip, 43> Ayr Agr G71 (24) 


45 





Mees em Or Stave veetor of attitude, position, and 
meroocivy errors 


on x = [ey Ep» €p) Sills 62 5 sh}! (Ze) 


It is quite important to emphasize that a computer simula- 
tion program developed in accordance with the above equation 
Matpeis Valid for all possible [I.N.S. configurations, space 
Stabilized, straodown, wander-azimuth and not only for tne 
local-level one. Both the coordinate frame nechanized Dy 
the inertial instruments and the computation frame are 
Semenecely arbitrary. It is only the foreing function, q, 
which depends on the system configuration through the angu- 
lar velocity and orientation of the inertial instruments. 
itnmeoGaer co rewrive tois equation as a first order 
Meeeer-difrerential equation the error state or the I.N.5. 


Menderined as {[Ref. 2]: 
oi (t) = Leys €ey Eps ig ee mee eee oid U-aroeme =) Mersmaec) gto sh] (23) 


and for the case of this study for two-accelerometer local- 


level I.N.S. system this reduces to: 

} 

ser) = Ley» Eps Eps Cheech, ob, 61] (24) 
where the seven basic I.N.S. errors are: 


nerth, eGaiset, down platform tisbt errors 


ay -E? =D 


je SL = latitude, longitude position errors 
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by 
epee est p/ 5 
F 63 = [p/r 


Fey sve Gia: 2w,,) COs 2L 
P be = =X Sin 2 


Pa, = Py/r eos. 


Fo2 = -f)/r cos L 
Poy = l ous OAL 
Fog = Bieeeany L 
P24 - 2 tan L 
Eee | error vector matrix 


where 


— = Ley, ae Spt SL, oe ie se 


G. = 5 TOmelng Matrix, with non=zero elements 


Gy, 


il 
_—, 


G 


i 
— 


ee 


a8 ¢ 
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éL, 61 = latitude, longitude rate errors 


The above statements allow equation (20) to be written as: 


ee = Ft + Geq C2a>) 


where: 


(em encor emacr ix with non-zero elenents 


Pao 22) sine L 
Fi3 = ic 

ames -) sin L 
Pa = cos ue 
Pr } sin L 
F 53 =A COces 
ees = 

Fa, = ai 

F 25 > -)} cos L 
Foy = Se cos 
F 37 = seeoneeL 
7) 
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Vale 


G 
Or 
pi 

ui 


Wie ior le 


op) 
ul 


and q = 5 x 1 forcing vector matrix 


where 


Ht 
Q = [ay, Ope ot S18. qe C23) 


7 


and neglecting both gyro and accelerometer non-orthogonalivy 
peeotorcne forcing functions are comprised of 10 I.N.5. 


component errors as below: 


q, (ud wy K 0 0 
q5 ae Oi (U)we | + one 0) re 0 ree 
| | 
q CO 0 0 Ts 
5 | D | L 7 | 
ag) 
qy (uj, 39 
n 
Vs = C. Cu) ft, + Ne 
0 0 6 


Where for our study of two accelerometer local-level system 


; n 
the platform-to-navigation transformation matrix C and the 


p 
ima.s. pieitform torquing rate bin are as below: 
h cos L 
a p _ _? 
: =i ; Yip > e (30) 
i SH Lb 
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Pies. soro1eM MODEL MATRICES Pe AND G. 


0 0 7 
O P56 O 

Q 0 Pas 

0 i si (26) 
0 0 Fan 

0 0 Fe 

2 come 877 | 

0 

0 

0 

9 (ap 
0 

0) 
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Finally the foreing vector matrix is modeled for our case 


as: 


qd; CU) wy + ry COS E 
I> Cu)oy 

q = a3) = | (Wap - © yh Saud (31) 
a4 | [Carty ~ &, 


15 | lea: rie 


Peeerror Equations Solution 


0“ 


Tiewesolution of che differential equations 
represented by equation (25) gives the error response for 
the two-accelerometer local-level navigator for arbitrary 
venicle motion within the constraints implied by a "first- 
eee sanalysis. Since the coefficients of tne differential 
equations are time varying the analytic solution of equation 
(25) would be quite tedious and require the uSer of a 
computer program to generate flight profiles. In our study 
Specific cases are examined so that the coefficients of tne 
differential equations can easily be calculated. 

The specific cases which are examined are the 
voviowlme three: 

1) Stationary case, where h = Ws 6 and ete = 1 een =P) 
2) Easterly flight at 600 "ft/sec" or 355.5 "knots," 


where X = 1.557 x Wie 


Je 





Spmeicevernly flight at -oGO "ft/sec" or 355.5 "knots," 


where 1 = 0.442 x uo. 
ie 
Wieediaee tae equation (25) in terms of the error 
States explicitly we have the following system of differen- 


tial equations which must be solved simultaneously: 


x (1) 


~\(sinL)x(2) - A(sinL)x(4) + (cosL)x(7) + 4, 
Meas (Sinl)x(1) + ’(cosL)x(3) - x(6) + a> 


ge = =i (cosl)x(2) - A(cosL)x(4) - (sinL)x(7) + 93 


x(4) = x(6) (32) 
Wey = x(T) 
Moe x (2) = 10sin2L)x(7) + qi 


Db 


mor) = - stSesLy x(1) + 2h(tanL)x(6) + 4. 

The values of the parameters used for the computer 
simulation are given in Table Il. 

Epeemcodstane Gyro Dritt Errors 

Powe miyeconctamt gyro drift be themsole error 

source in the I.N.S. system where the constant gyro drift 
rates (U)wy, (U)we, (U)wp are associated with the qeneaaie 
east, and azimuth gyros respectively, computer simulation 


verfied the following. 


a2 





Peebe Ll 


COMPUTER SIMULATION PARAMETERS 


Geographic Latitude, L 
ieeaeetrial Longitude, 1 
Berth Rate, Wie 
Somecant Gyro Drift 

« North, CU) ay 

meiast , Cu) os 

¢ AZimuth, Cu) wp 
Constant Accelerometer Bias 

weor tn , Cu) fa 

* East, (u)t. 
tial Platform Tilt 

_Hortn, €, (0) 

¢ East, e- (0) 

meazEnuth , en (0) 
emer Latitude Error, $sL(0) 
Meee al Congitude Error, 5§1(0) 
ioral Latitude Rate Error, 5L(0) 
Mrmeeial Longitude Rate Error, 61(0) 
Svatienary Flight 
Comseant Basterly Flight at 600 ft/sec 
Constant Westerly Flight at 600 ft/sec 
Gravitational Acceleration Constant 
Earth Radius 


ys 7 
g? (Greenwich) 
0.2618 Rad/hour 


1 meru ep 
Prer u 
1 meru 
200 ug (2) 
2O00ug 
O.14 mrad 
0.14 mrad 
0.14 mrad 
O. iemrad C3) 
O.i17 mrad 
Ol ey Werevel (4) 
O.34 mrad 
- Pie 
; = 1.557xo, , 
A = 0. 44exu, , 
= 32.2 ft/sec 
=06, 3 eee 


>) Wwe Ris ZYRO drift of 1 méru corresponds to 0.015°/hr or 


Cee) 356.10 rad/hr . 


os «6 RAS acgelerometer, bias of 200ug corresponds to 


0.4356x10 em. ( Or. 


3. Tne RMS position error of 0.17 mrad corresponds to 1085m 


or 0.586 are min. 


4. The RMS velocity error of 0.34 mrad corresponds to 


2 {}t/ siec . 
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For the stationary case we observe in Figures 4 
@rmrouwgn 10 that for the north and east level errors, ay and 
Eps the Foucault modulation is an effect of first-order in 
contrast with the latitude, longitude and azimuth errors 6L, 
S51, and Ep respectively where the Foucault modulation has 
only a second-order effect [Ref. 1]. These computer 
solution results suggest that it would be convenient, for 
design purposes, to neglect the Foucault modulation since 
the equations we obtain then are easily solved and give 
solutions with approximately the same amplitude information 
for latitude and longitude which are of primary importance 
for navigational purposes while the relatively poor 
information of tne level errors is of secondary importance. 

We furtner note from these computer grapn 
sOlutions that the effect of the Foucault terms in tne error 
equations system, is to modulate the Schuler oscillations at 
a frequency given by the local vertical projection of earth 
rate, namely uw. 


ie 
33.9 hours for the selected latitude L = 45 


<'sin ©, which cerresponds mo a period of 


O 
For the case of constant easterly flight at 600 


ft/sec the results are given in Figures 11 to 17. Compari- 


son with the curves for the stationary case indicates that 


the lowest modulation frequency has increased from A we 


po f = oor Xk Ds and the space rate period is 10.9 hours 


While the Foucault modulation now occurs with a period of 
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about 21.8 hours instead of the 33.9 hours period for the 
Stationary case. 

Another important feature revealed by the above 
comparison is that the azimuth and latitude errors are 
reduced from the corresponding for the stationary case by a 
factor of 1.557 which represents the ratio A/ Ws 4 NOtaetall S 
case. 

For the responses to the nortn and azimuth zero 
drift, (u)wy and (u)wp,, the venicle motion appears to nave 
mepere efirect on the error growth in the cases that exhibdic 
a longitude error which grows with time. 

ime leyel errors in response to> level gyrowdrift 
are seen to remain unchanged while the level error response 
Bemmeeemocnh gyro drift, (u) ws: iS seen to emerge from the 
computer noise having a peak value of 2.3 rad/meru (rigure 
13). 

The longitude error in response to azimuth gyro 
drift which was bounded for the stationary case 1S now 
memneea by the factor M/s 6 er by 1.55 While vite. Watitude 
and longitude rate error magnitudes are unaffected by the 
vehicle motion. 

Pamakly for t® westerly flight case it is 
verified that the level errors remain unchanged without the 
effect of Foucault modulation, but the latitude, longitude, 


and azimuth errors grow approximately in proportion to the 


Die. 





CUlbmesdritit rate prodct. The computer solution graphs for 
the westerly flight case are shown in Figures 19 through 24. 

Similar results are found for the cases of east 
framazimuth gyro drift but they are not included here due to 
arg? amount of graphs. 

b. Accelerometer Bias Errors 

Considering the accelerometer bias as the sole 
error source computer simulation of equations (25) shows the 
Pommmowine result of the effects of the north and east 
accelerometer bias, (u)ty and (u)f, respectively, on the 
navigation and level errors. 

For tne stationary case the rasults are snown in 
Figures 25 through 31. We note that the Schuler mode is 
Oredominant since the accelerometer bias directly excites 
the relatively high gain level loops and tnat tne Sehutler 
oScillations are modulated at the Foucault mode frequency of 
33.9 hours per cycle. The maximum values for the navigation 
errors proved to be in the range of 20 x 107! paay 20Gh. 2s (for 
the latitude error and 1.4 x 1076 maces 00. wuemeor tne 
POomg vugde serror. 

We notice as for the constant gyro drift case 
that we can neglect the effects of Foucault modulations as 
first-order ones and proceed in the solution of the 
resulting equations more easily obtaining almost the same 
approximate amplitude information of the navigation and 
level errors. 
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Bor tae case of constant easterly flight at 600 
ft/sec the computer simulation graphs are shown in Figures 
32 through 38. We observe here that again the Foucault 
modulating frequency has increased by a factor of 1.55 which 


Somtresponds to the ratio Jw; Nevertheless we see that 


~ 
the error sensitivities remain unchanged with the previously 
explained stationary case. 

Figures 39-45 snow computer solutions of tne 
Navigation and level errors for the case of westerly flignt 
at 000 ft/sec. 

We see now that the Foucault modulating 
frequency has decreased by a factor 0.442 corresoonding to 
the ratio M/ 5 In this case and once again we can proceed 
Pomene Solution of the equations without considering tne 
Foucault terms, especially for design purposes. dn easy 
extension of the above observations is that for the limiting 


case when the terrestrial longtitude rate, 1, in a western 


direction is equal to the earth rate, ua. then the Foucault 


er’ 
modulation disappears completely leaving a pure Schuler 
oscillation. 
&. @iaeitia) Condition “Errors 
The results on the navigation and level errors 


due to effects of the initial conditions are now presented 


accompanied by only the most important graphs of the 


Si) 





computer simulation since the total amount of graphs is too 
Marge to be included in this study. 

For the stationary case selected graphs 
representing the level errors for an initial north, east and 
azimuth level error of 0.14 mrad or 0.438 arc-min are shown 
in Figures 46-47, 48-49, and 50-51 respectively. 

Figures 52 through 57 oresent the level and 
aeeeeation errors for an initial latitude rate error of 2 
ft/sec corresponding to 0.34 mrad/hour while figures 538 
through 63 show the associated errors with an initial 
longitude rate error of the same amount. 

There is no need to include any graphs for the 
Mmeeulting errors due to initial longitude error sinee by 
inspection of the error differential equations we can See 
Siaombonegivude is uncoupled from tne other computation loops 
so that an initial longitude error holds constant and no 
other error becomes non-zero. 

We discussed up to now the errors of a pure 
I.N.S. system. In the next chapter we proceed witn the 
consideration of the combined I.N.S./G.P.S. system and the 


results we achieved after computer simulation. 
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Peeeieinony Gee .o. S’oIEM MODEL AND EQUATIONS SOLUTION 


In order to apply the Kalman filter equations discussed 
in Chapter [I a reference system model which is a good 
approximation to the real world dynamics is needed. 

In this chapter we outline the reference I.N.S./G.P.5. 
system equations selected for this study. Firse we are 
defining the error states incorporated in the system model 
along with their assumed initial conditions values. Next we 
@rsemias tne modeling of the I.N.S. plant error states and 
finally we present the equations for the integrated 
ivgieioe/G.P.5. system together with their simulated computer 


pesuits. 


Semon oleM MODEL 
1. State Variable Definition and Initial Conditions 

In Table III we present a listing of the state 
variables utilized in the reference system model. The 
initial conditions on the I.N.S. error states are nighly 
arbitrary and the selected values are similar to those used 
in other unclassified studes [Refs. 4,5]. 

Por the initial conditions on the gyro error states 
and the accelerometer, the values are selected for a typical 
inertial navigation system of one nautical mile per hour 


class. 
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After the above definition of the initial conditions 
we have by the same time specified in a complete wav the 
initial covariance matrix P(0), since its diagonal elements 
are the squared values of the given RMS initial conditions. 
The remaining off-diagonal elements of the initial covar- 
iance matrix are assumed to be zero initially. 

Furthermore the propagation of the linear variance 
equation (13) requires an additional knowledge of tne two 


Matrices F and Q* where: 
Q*% = GQG (23) 
where 
meses coe forcing input matrix 
Secmene input noise covanbance matrix 


and the F matrix is the same as in Equation (25) and whicn 
has been used in the previous chapter for the inertial 
navigation system error equations solution and computer 
simulation. 

For the Q* matrix the only non-zero elements are all 
diagonal and we will denote these from now on as Q5 where 
the subscript i denotes the row and column of the value. 

For example, Q3 indicates that this is the value which 


belomeis to the interGection of the 3rd row and the 3rd 
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column in the Q* matrix and corresponds to a white nolse 
input on state variable number 3. 

These non-zero elements in the reference system Q* 
matrix are five, corresponding to state numbers 1, 2, 3, 6 
Seem, according to the notation of Table III. 

foe ant Error States 

ioe 1OMuGweageeseyven states, Norton, East, and Azimuth 
meet errors, X and Y pesition errors, X and Y velocity 
Pepors, constitute the plant error states. The differential 
equations of these states describe the natural unforced 
dynamic response of the errors in the inertial navigation 
Sys Liem . 

There are various models for the inplementation of 
these error states. As we did in the previous chapter we 
Mel). use again the Pinson error model described by tne 
Matrix F given in equation (25) for our specific case of the 
local-level two-accelerometer inertial navigation system 


configuration. 


B. EQUATIONS SOLUTION AND COMPUTER SIMULATION 
Using the definitions described in previous pages we can 


write the following equations for the error states: 


X(t) 


T 
hes) 
lx 


(t) + G wt) 
(34) 


z(t) 


H x(t) + v(t) 


ol 





PABee [Lt 





reece. os. SLOleMeSTATE VECTOR DEFINITION 
Eeror 
State Symbol Definition howe COondl tion 
vis s. Peee lee RROR STATES 

ibe ey North atttiude error 0.14x107> Rad 

oe Eo Fast attitude error 0.14x1079 Rad 

ae En Azimuth attitude error 0.14x107? Rad 

4, 6 L Ye pocheton error 0.17x107° Rad a 
oe él X position error 0.17x107> Rad 

OF 51 Yovetocity error 0.34x1072 er 
has sal A velocity error 0.34x107? Rad/hour 

ioeee kon SOURCES 

g, CU) wy Werth Gyro Drift 1 meru ae), 
9. (U)wE East Gyro Drift 1 meru 

AOe Cu)wp noremetn Gyro Drift 1 meru 

11 (u)fy North Accelerometer Bias 200x107°s (4) 
We. Cu) f, East Aecelerometer Bias 200x107 %g 
ieeidemni> pDOSitionm error of 0.17 milliradians correponds to 


i@esm or ©.586 are min. 
ee eitem nits Velocity terror of 0.34 millirad/hour corresponds 
to 2 Btfsec. , 
Sette RS euro @rift of 1 meru cerresponds to 0.015 /hr or 


No Vs Cam 
4. The RMS ae 
O.4356x10- 


rag? heur . 


gelerometer bias of 200x107° 


rad 7@nr )>. 
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eorrmespondise to 





where 


x(t) 


| 


IO 


z(t) 


| ote 


fox | “emror state vector 


Ce ys Ep, Ep, SL, Sl, $L, é1]° 


7 x 7 Pinson error model matrix 


as described in equation (25) 


foo Lp rorcing maitrix as described 


in equation (25) 
2 x 1 vector of measured states 


2 x 7 measurement matrix where 


ok 
TT 
ee 


denoting that we have available measured information for tne 


Awean@ ¥Y position error. 


and 


w(t) 


v(t) 


5 x 1 foreing vector assumed to be white 


Gaussian noise 


oe xX 1 vector of measurements noise assumed to 


be white Gaussian. 


Using the feedback configuration of the Kalman filter we 


can write the following equations: 
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x(t) 265 x(t) + Gw(t) + K[z - i (el (Sa) 
and 

b(t) =F P+Ppr'+GQG'-PH' RHP (36) 
where 

Prt) = the covariance matrix 

K = P a! Ro! the Kalman filter gains matrix 

R = the measurement noise covariance matrix 

In order to achieve numerical results via computer 
Simulation we write the predicted error states of our system 


in explicit form as below with the help of Table IV in whicn 


the system 
defined: 
me ]) = 


me) = 


Raa) eS 


~ 
rn 
J 

——Z 
iT 


States and their corresponding symbols are 


Mecsi nine) = esa eiimeeSesiL) x (7) + AA + 


eG (x Ca GH) eee pix (ope (5) 1 (35-a) 


i(sinL)%(1) + \(cosL)x(3) - x%(6) + BB + 


+ K,0%(8) - RC4)] + Kyfk(9) - €(5)] (35-0) 


~\(cosL)%(2) = 4(cosL)x(4) = (sinL)x(7) + SS + 


R(6) # K,,0%(8) - XC4)] + Kyolk(9) - %(5)) (35-4) 
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x(1) 
eG ) 
C3 ) 
x (4) 
(5) 
x (6) 
X(7) 
mS ) 
x(9) 
ec 10) 
x¢ 11) 
rot ee 
cece) 


AA 


BB 


TABLE IV 


COMPUTER SIMULATION VARIABLES AND CONSTANTS 


2] 
[Cu)uy] 
[(uyug]* 
[(udwpI* 
Gy at is 

N 

ee 
(Cu) f,] 
R 


11 


Roo 


me lia) A 


ee) 8B 


NOmGo attitude error 

East attitude error 

Azimuth attitude error 
Yeeesrivowewerror 

heDoS He Lon, error 

weve locity wverror 

X velocity error 

G2P.5. Y position error measurement 
G-P.S. X position error measurement 
ieee, posielon error 

iete L.SoSicion error 

Input wnite Gaussian noise 


Measurement white Gaussian noise 


North Gyro Brat Variance 

Past, Gyro Draft Variance 

Azimuth Gyro Drift Variance 

North Accelerometer Bias Variance 

East Accelerometer Bias Variance 

Measured Y position error variance 
Measured X position error variance 

White noise like North Gyro Drift strength 


White noise like East Gyro Drift strength 
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SS 


DD 


=a] 


GG 


Keele ) o> 


mane) * > 


eee) & 


patel. 3.) * F 
mC 13)°G 


ar 


TAs IV GCOntINveD) 


White noise like 
strength 


White noise like 
bias strengtn 


VWnite noise Like 
hias strength 


White noise like 
White noise like 


Seonsvant 
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Azimuth Gyro Drift 
North Accelerometer 
tast Accelerometer 


Y=position ‘error strengtn 


X-position error strength 





K(5) = (7) + Koy(R(8) - RCH)] + Kool K(9) - R(5)] (35-e) 


(6) = kX¥(2) - (4(sin2L)%(7) + DD + 

a Ke LX (8) = X(4)] aa Keolx(9) - x(5)] (35-f) 
K(7) = = wher R(1) + 2i(tanL)&(6) + EE + 

+ Ka 08 (8) = 2 ee Kol k(9) - ¥(5)] (35-g) 


Assuming the input forcing vector as white Gaussian 
nolse whose strength is related to the value of the variance 
Se eacm@ input error source (the corresponding one) computer 
Simulation was proceeded in tne following way. 

Mmmest. With the help of the RICATI FILTER computer 
program available at the NPS wW.R. Churen Computer Center we 
solved the corresponding for our study Ricati equation of 
covariance propagation obtaining the Kalman filter gain 
matrix. The data we used to run the above program are 
provided in Tables III and V. A listing of the data 
eoemeration for the RICATI FILTER program is given in 
Appendix D. 

The calculated from the above program values of the 
Kalman filter gains for a processing period of four hours 
eeé @iven in the following Table VI. 

Additional runs of the above program have been contacted 
for processing periods up to 36 hours and it has been 


observed that the Kalman filter gains reach a steady state 
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TABLE V 


NUMERICAL VALUES FOR RICATI PROGRAM | 


Peetatrix (7 x 7) 


Pio = =O. 1851 Foy = -0.1851 P47 = Ue fOr 
Fo, = 0.1851 Foz = 0.1851 Fog 7 71-0 
Foy = -0.1851 Fa, = -0-1851 Faq = -9.707 
= 1-0 

Foo = 1.0 

Fe, = 19.92 Fez = -0.2618 

Foy = -28.175 Tay He Ona 


All other elements are zero. 


gl iepetmex (5 x 7) 
G44 = G55 = G33 = 
Gi =020915 


G 


57 0.1294 


All other elements are zero. 


Heitacrax (2 x 7) 


H H 1.0 


a - “a5 - 


All other elements are zero. 


iRer the used values of elements in the matrices the 
results will be given having units the appropriate for each 
case combination of radians and hours. 
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TABLE V (CONTINUED) 


@earrix (5 x 5) 


Q11 = Von = Qqq = [0.0002618 rad/nr]® = 0.72107! [rad/nr]* 


eh = 2 (0.0008356 rad/(hr)21° = 0.19x107°[rad/(hr) 71° 


i) 


DS, 


All other elements are zero, 


Retacrix (2 x 2) 


= 0.52x107” (rad]° 


MN 
MN 
j 


rk oun =O. 
Beepeewatrix (7 x 7) 


: 2 a-[- Ae 
P4469) = Piro 60) = 240) =O O00 Geadejme = 0. <1 0° eas 


2? | , 2 
Py (0) = P55 (0) =O. 00017 radars 200.3410" inad/art™ 


enor 
Peg 60) = P47(0) = [0.00034 rad/(hr) "J" = 


OMS 10. Mme seo) 


All other off-diagonal elements are zero. 
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DeD LE SVL 


KALMAN FILTER CASE FOR A 4 


- 034756672 


P20 5500 


-44020611 


-0907281520 


~92162434 


O44 5 354 


70 


HOUR 


PROCESS 


cARe2O le 


OU b OOF 7 > 


- 86193609 


C907 26150 


- 31037639 


Sh ei ual ae 


era Oe aout 





Semoweoromn £Or whieh their values are not very much different 
from those achieved for a 4 hour processing period. 

50 in the following calculations and computer Simulation 
we have used the values of the Kalman filter gains resulted 
for a 4 hour simulation period. 

Having available the values of Kalman filter gain matrix 
elements which are used to multiply the residuals in the 
appropriate equations in order to achieve the predicted 
Semen states of the integrated I.N.S./G.P.S. system, the 
appropriate program has been formulated in order to solve 
the error differential equations (32) described above, wit” 
the use of the available routine INTEG2S slightly modified 
for accurate evaluation and plot of the error state 
variables. 

fee Simulation results for the I.N.S./G.P.S. system 
Speracvon for~a period of four (4) hours»are presented below 
in Figures 64 through 93. We can easily observe that all 
Ge Stave error variables of the combined I.N.S8./G.P.5. 
System are damped out and the resulting value of the errors 
after a period of one (1) hour is small enough so that the 
epermaction of our system model can be characterized as 
successful. 

Specifically in Figure 64 we observe that the north 
level error of our system is dropped down to 0.025 milli- 


radians after one (1) hour even if the starting initial 


fas 





Semeetion value was 0.14 milliradians. Furthermore at the 
end of a 4 hour period the error has been diminished to the 
Value of 0.005 milliradians which is subject to error 
me@uetion by a faetor of 28. 

In Figures 65 and 66 the East and Azimuth attitude 
errors are presented respectively where similar as with the 
north attitude error observations occur. 

Tae Y position error behavior is presented in Figure 67. 
There we can see that even if we started from an initial 
@em@meion error of 0.17 milliradians (or 3256 ft) after one 
nour processing the error has been diminished to only 0.028 
meeeradweans (or 5360 ft) and furtnermore after a four nour 
Wemeegetnis error droos down to 0.01 milliradians (or 
leas > ft). : 

The X position error damping out seems to be more 
attractive since from Figure 68 we can see that after one 
Wemmeeeae error drops down to 0.020 milliradians (or 383 ft) 
and at the end of a four hour period the error is diminished 
to 0.0002 milliradians (or 3.83 ft) which is very small con- 
Sidering also that we started with an initial condition 
meapesof the X position error of 0.17 milliradians (or 
Be50" Gt). 

Figure 69 presents the propagation of Y velocity error. 
It is easily observed that this error drops down to the very 


a 
Small value of 0.040 milliradians/hour (or 68 x 10 ft/sec) 
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after one hour and to the negligible error of 0.00e 
mMilliradians/hour (or 34 x 107? it/sec whiten prov ides tne 
advantage of very accurate evaluation and tracking of the Y 
velocity state variable. 

Similar with the above considerations and even better 
results occur for the case of the X velocity error of the 
Meeeraved i.N.S./G.P.S. syStem. We see from Figure 70 that 
meseerror starting from an initial condition value of 0.34 
@meeeradbans/hnour (or 2 ft/sec) drops down to 0.1 milli- 
mad@ans/hour (or 17 x 1079 ft/sec) “atter one hour cperation 
and furthermore down to 0.002 milliradians/hour (or 34 x 
107? mo/sec) after a period of four hours which again 
Gemleees a very accurate tracking of the X velocity error 
State variable. 

In Figures 71 and 72 the normalized inserted and 
measurement noise of the combined I.N.S./G.P.5S. systems are 
Pmemeentved respectively. 

Thinking of the operation of our system in the long 
term, results of the computer simulation are presented in 
Figures 73 through 79. Using the same input data for our 
I.N.S./G.P.S. system model and running the program for a 
36 hour process we see that the behavior of the feedback 
configration of the Kalman filter in our system continues to 
be attractive throughout the long term period of interest 


without diverging at any moment. 
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ia aeaitren to the above considerations, in order to 
make our system more realistic and compatible to the real 
world's conditions we put some noise in the two error state 
equations of X and Y position which did not include any 
noise from our theoretical design of the system. So we 
replace the two equations (35-d) and (35-e) in our system of 


equations witn the following two equations: 


a 


K(H) = R(6) + AA + Ky fR(8) - R(4)] + Kyolxt9) = R(5)] (35-4') 


and 


a 


x(5) 


Re AA Ko 1XC8) - xC4)) + Ke5EkC9) = &(5)]) (35-e") 


Mestening to the strength of this intentionally inserted 
nemse a value similar to that of the strength of the gyro 
wemee (that is a value of 0.0685 x 197° frad]}*) we ran the 
Same program and we achieved results proving that tne 
combined I.N.S./G.P.S. system reacted in a way exactly tne 
Same @s it had reacted without the inserted noise in the xX 
and Y position error equations. So we make the conclusion 
that the intentionally inserted noise did not affect the 
operation of our system model neither from the accuracy 
point of view nor from the time point of view. 

The above considerations and results can be seen in 
Figures 80 through 86 for the four (4) hours short term 
process and in Figures 87 through 93 for the 36 hours long 
term operation. 
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In Table VII on the next page we summarized the state 
eimors Of ¢ne combined I.N.S./G.P.S. system after a period 
of two and four hours operation. In the same table we 
mremuded the starting initial condition for each error state 
in order to make our comparisons easier and handy. The 
results included in Table VII are those achieved from the 
computer simulation without any noise corrupting the two 
Sameer staves of Y and X position. But since the addition of 
MmGise Witn strength similar to that of the gyro drift 


: [rad]‘) did not affect the system model 


momooe> x 10 
Operation as mentioned before, the same Table VII represents 
Eeesem cae Summary of state errors for the real World's system 
Memet Of the I.N.S./G.P.S. system. 

Up to now we considered our system to be corrupted vy 
Wieeoe GausSian input noise. Since in the real world in many 
cases the presence of colored noise iS apparent we must 
conSider the operation of our I.N.S./G.P.S. system under the 
presence of such noise and compare the results with those 
achieved when the system was driven by white noise. 

In the following section a realistic modeling of the 
I.N.S. component errors is discussed and the results of the 
computer simulation are presented together with the compari- 
son conclusions of the system's operation under colored 


noise versus white noise corruption. 
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PABGE VIE 


Sermeny OF STATE ERRORS FOR THE I.N.S./G.P.S. SYSTEM MODEL 


State 


ERror 


éL 


$1 


ab 


fag ia | 
Condition 


Of 14 onrad 
0.14 mrad 
O- | 4enr ad 


O17 sur ad 
C3250 ft ) 


Omen, mrad 
3250 ff) 


O.34 mrad/nr 
(2 ft/sec) 


O. 34 mrad/nhr 
Cea c/ sec.) 


Error’in 2 neurs 


e025 mrad 


0.021 mrad 


QO.04 mrad 


0.928 mrad 
Cycles om 


O70 20.-9raq 
(263, fit) 


QO.O040 mrad/nar 
GCOmOOoG. 1 t7 sec) 


O.1 mrad/hr 
CiOn OM arbi. SCC 
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ELrreorein 4-Rhours 


0.005 mrad 


Q.901 mrad 


Q.02 mrad 


O20 l= mrad 
CV, 5 1G) 


OeeCOe mrad 
Co orice 


OOO mMrad/ ar 
(Cimomocs Tt/sec,) 


OmoOoenrad/’ Ar 
(Os0Oes4 ft/sec) 





c. 2.855) COMPONENT ERROR MODELS 

in Gaaipter II] equation (31) indicates that the I.N.5. 
component errors consist of three gyro drift uncertainties, 
two accelerometer measurement uncertainties, two gyro 
torquer scale factor errors and two geodetic uncertainties. 
Realistic modeling of the two major error components, the 
@vro drift and the accelerometer measurement is described 
below. 

meeoyro Demit Uncertainties 

The three gyro drift uncertainties, CU)wys CU)ups 

(U)wp are each modeled as an exponentially-correlated 


Geemsered) noise plus an additive random, (white) noise: 


Cuda; = a + WwW. ; 1 = Nee C37) 


O34 
, is. | : 
where the colored noise is determined by: 





. = = E Sen or OV (3e> 


The Puciugesentsetne correlation time of the colored noise 


aL 

and the v, the strength of the driving white noise obtained 

wee? 
uSing the specified variance a5. of the colored noise and 
the formula 

gs 29... St (39) 

‘~ 7 6L @&. 
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The quantity Ws is a white noise of specified strength. 
1 


7 





2. Accelerometer Measurement Uncertainties 
The accelerometer measurement uncertainties (u)fy 
and Cu) f, are modeled in the same way as the gyro drift 


O@ieertainties, as colored noise plus white noise: 


Cpe. = ae W ; i=N, E (40) 


_ 


wnere again We womedewwiite NOisSe of specifled strengtia 
i 
mm@eecnme colored noise is given by: 


° 1 
-_s - . + 
i eta a el) 
a. i 
i 
wnere oe morc@e Correlation CMe of tne colored noise 
: Z 
With variance tT. Gqemecae  screngea ot tne wdriving waite 
i: 
noise v, 1s given by: 
i 
Q a 2 og ye (42) 
V a. Al 
a. iL 1 
i 


Be Computer Simulation Kesults 
Using the same set of equations (35-a) through 
(35-2) but introducing the appropriate state augmentation 
in order to incorporate the exponentially correlated noise 
for the gyro drift and the accelerometer measurement, we 
simulbaved the operation of the combined I.N.S./G.P.5. system 


and achieved the following result. 
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The operation of the system proved to be excellent 
for all the used correlation times from 60 seconds up to 
3600 seconds (1 hour). The attitude and navigation errors 
were found to behave in the same way being minimized after a 
period of one hour. Furthermore, the variation of the 
@eertude and navigation errors is similar with the case of 
the white noise driven I.N.S./G.P.S. combined system whicn 
wean 1S Similar, if not exactly the same, with tne ideal 
imumewo.e/G.P.S. system. 

ieeoures 94 through 100 we present the I.N.S./G.P.5. 
system operation for an exponentially correlated input noise 
Witn a correlation time of 1 hour (3600 sec). We can easily 
see in these figures that the behavior of the combined 
I.N.S./G.P.S. system is the same with that when white noise 
drives the input except for a very Small and negligiole 
ivemease of the attitude and navigation errors after the 


first hour of operation. 
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V. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 

From knowledge gained throughout this work and based on 
the material presented in our study, the following 
conclusions are drawn: 

AS far as the I.N.S. errors are concerned we saw that 
——iiemerfects of constant gyro drift errors for the 
Stationary case are related to Foucault modulation which has 
only a second-order effect on the longitude and latitude 
Srror states and permit us to negiect it in cheap systems 

designed for navigational purposes. 

Besor ene case of easterly flight, latitude errors 
Mere reduced by a factor of 1.557 whicn correponds to tne 
ratio M/s and Foucault modulation period reduced 
analogously from 33.9 hours to 21.8 hours. 

3. For the westerly flight, case longitude and latitude 
errors grow in approximate proportion to the time-drift rate 
Peodwe t . 

4, The accelerometer bias errors have the same effects 
for the stationary case as the gyro drift errors. 

5. The Foucault modulation period increased by the same 


as above factor of 1.557 for the easterly flight case, while 


for the westerly flight decreased by a factor of 0.442 
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corresponding again to the ration A/a, for the specitic 
case. 

6. The error sensitivities remain unchanged for the 
easterly and westerly flight and again we may neglect 
Foucault modulation as producing only second-order effects 
on the navigation states. 

Pen tne combined I.N.S./G.P.S. system the results 
Pemieved bY this study proved that the errors of the 
system's state variables are damped out in less than one 
hour, denoting effective and successful operation of the 
Meee ataing to the I.N.S. Specifically: 

7. Using suboptimal Kalman filter gains for one hour 
mmecess, the Y-poSition error reduced from its initial value 
Pemceaetor of 6 in one hour and by a factor of 1t7 ia four 
Cours). 

8. Witn the same suboptimal Kalman filter gains of one 
hour process, the X-position error proved the system more 
attractive since the error reduced by a factor of 8.5 after 
Smemaour and by a factor of 856 after four hours. 

9. Both the X and Y-velocity errors damped out very 
quickly so that after one hour the Y-velocity error reduced 
by a factor of 312.5 and the X-velocity error by a factor of 
117.6, while for a four-hour process both velocity errors 


Meaweed by va factor of 571 from its initial value. 


oi 





ion themcencideration of long term filter's operation 
proved no divergence at all for a process of 36 whole hours. 
The errors remained at the same attractive levels as for the 
four-hour process, fact which enables us to conclude that 
the combined I.N.S./G.P.S. system works with excellent 
results for both short and long term periods. 

ieee rimally the operation of the combined I1.N.S./G.P.5. 
system under exponentially correlated input noise proved to 
be excellent for all different correlation times from 60 sec 
Momco 3000 sec, With a negligible increase in the attitude 
and navigation error magnitudes after the first hour of 


@oeration. 


B. RECOMMENDATIONS 

Continued study of this work can be based on the 
following recommendations: 

1. A Kalman filter design study where the primary 
emphasis will be placed upon determination of the "best" 
filter state variable vector. A general covariance analysis 
program for the analysis, evaluation and design of Kalman 
filters, which will help this study, has been tape recorded 
from the Wright Patterson Air Force Base, Air Force Avionics 
Laboratory and modified by the author for use in N.P.S. 
campus computer. 

2. Investigation of various measurement rates using the 


external range measurements from a set of satellites in view 


82 





among the 18 of the G.P.S. and Kalman filter's performance 
for these rates. 

3. Possidle use of a flight profile generator progran, 
which will generate simulated flight patterns instead of 
considering specific only cases for stationary, easterly, 
and westerly flights, together with a satellite motion 
generator required to provide necessary information regard- 
ing the satellites' orbital elements. This recommendation 
maelres only to U.S. citizens since such programs already 
exist but they are classified. 

4. Investigation and results evaluation for the effects 
upon filter performance when range-rate measurements are 
availabie. Then a comparison witn the usage of only range 
measurements could be extracted. Another aspect for 
investigation could be the satellite bearing measurements to 
declare best observable satellites and to provide better 
Bec Ur alc y . 

Sse inmaliy a comparison of sequential versus simul- 
taneous measurement would be another area of interest. The 
performance of a filter working with sequential measurements 
is of interest primarily, because of the increased cost of 
equipment required to perform simultaneous measurements and 


computations as compared to the sequential ones. 
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me oeeee=!.00F+0l UNMTS INCH. [hours] 
eee 5.00F-05 UNITS INCH. ([ead/meru] 


AWS TAS 
RUN | FN’ VS TIME 


Figure 4. Stationary Case. North Level Error [rad/meru] 
for Constant North Gyro Drift {1 meru]. 
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Peoenee=!.00E*01 UNITS INCH, (hours} 
S006 —-.. 805-05 UNITS INCH. ([Rad/iteru] 


AWS TAS 
RUN | FE VS TIME 


Figure 5. Stationary Case. East Level Error [Rad/meru] for 
Constant North Gyro Drift [1 meru]. 
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Pose b=). 88F+O)] UNI IS LNCH. fours) 
T-SMLE=5.006-04 UNITS INCH. (fRed/mecu] 


AWOSTAS 
RUN | EU" VS TIMe 


Figure 6. Stationary Case. Azimuth Level Error [Rad/meru] 
for Constant North Gyro Drift [1 meru}. 
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ome | OBE+tO! UNITS INCH. Ubeurs] 
Y-SCALE=5.00E-O0Q4H UNITS INCH. [Rad/meru] 


AWS TAS 
RUN | DLA VS TIME 


Figure 7. Stationary Case. Latitude Error [Rad/meru] for 
Constant North Gyro Drift [1 meru]. 
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See OE TO UNITS INCH. (ietes; 
PeleimeeaerOOE-OS UNTIS INCH. [rad/meruy 
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RUN 2 ULO VS TIME 


Figure 8. Stationary Case. Longitude Error [Rad/meru] for 
Conemamt North Gyro Drift [1 meru]. 
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Figure 9. Stationary Case. LatseudemRate Error 
[Rad/hours-meru] for Constant North Gyro Dei £t 


(1 meru]. 
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@oeoeaee=i|,.00E+C01 UNITS INCHeaikeurs] 
Y-SCALE=5.00E-04 UNITS INCH. [Rad/hour-meru] 


AWS!HS 
RUN e JLOD VS TIME 


Figure 10. Stationary Case. Longitude Rate Error 
[Rad/hour-meru] for Constant North Gyro Drift 


[1 meru]. 
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meoegee=!.00E+0t UNITS INCH. (heurs) 
foe: —1.00F-01 SNL) Say Cie (Rad/meru] 
AWSTHS 

RUN | F YN’ VS TIME 


Fugure 11. Easterly Flight at 600 ft/sec. 
North Level Error [Rad/meru] for Constant 
North Gyro Drift [1 meru]. 
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Peesieelr=);00F+01 UNITS INCH» fhougs ] 
Y-SCALE=1.00E-01 UNITS INCH. [Rad/meru] 


AWSTRS | 
RUN 1 ) Ee’ VS «Ce 


Froure 12. Easterly Flight at 600 ft/sec 
East Level Error [Rad/meru] for Constant North 
Gywo Drift [1 meru]. 
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se oee=-. GOE+O0 Gite |S [ Niele [Rad/meru] 


AWOTHS 
RUN | F'D' VS TIME 


Figure 13. Easterly Flight at 600 ft/sec. 
Azimuth Level Error [Rad/meru] for Constant 
fomemeGyro Uritt [1 meru | . 
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X-SCALE=1.00E+01 UNITS I[NCH. [hours] 
fPoeelbe=!.00E+00 UNITS INCH. [Rad/meru] 


KAWOTHS 
RUN 1 DLA VS TIME 


Pigere 14. Easterly Flight at 600 ft/sec. 
Latitude Error [Rad/meru] for Constant North 
Gyro Drift [1 meru]. 
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X-SCALE=1.00E+01 UNITS INCH. [hours] 
Y-SCALE=1.00E+01 UNITS INCH. [Rad/meru] 


AWSTAS 
RUN 2 DLO VS TIME 


Pigume 25. Easterly Flight at 600 ft/sec. 
Longitude Error [Rad/meru] for Constant North 
Gyro Dritt {a meru]. 
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faeaenien= |. OGRAOO UNE IS INCH. [Rad/hour:-meru] 


AWOTAS 
RUN e DLAD VS TIME 


Fiygume 26. Easterly Flight at 600 ft/sec. 
Latitude Rate Error [Rad/hour-meru] for Constant 
Nowe Gyro Draét [1 merw]. 
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AWSTAS 
RUN e BLOOD VS TIME 


Figure 17. Easterly Flight at 600 ft/sec. 
Longitude rate error [Rad/hour-meru] for Constant 


North Gyro Drift [1 merw). 
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Figure 18. 
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Westerly Flight at 600 ft/sec. 
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Piemre 19. 


East Level Error [Rad/meru] for Constant North 


Gyune Deirtt [1 meru]. 
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Figure 20. Westerly Flight at 600 ft/sec. 
Azimuth Level Error [|Rad/meru] for Constant 
Neren Gyro Britt {1 meru]. 
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Pose hive= |. 00&+01 UNIIS INCH. [hours] 
Poe sie  UUE UU UNI IS INCH. [Rad/meru] 


AWS TAS 
RUN | ULA VS {IMe 


Beoure 21. Westerly Flight at 600 ft/sec. 
iacltuge Error [|[Rad/meru] for Constant North 
Gyro Britt [1 Meru}. 
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Figure 22. Westerly Flight at 600 ft/sec. 
Longitude Error [Rad/meru] for Constant North 
Gyaner Dna tt {1 meru). 
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oa eestee=|, 086701 UNITS INCH. Thems) 
Poe see= i. OOOO UNITS INCH. [Rad/feermeru] 


AWOTAS 


RUN 2 OLUD VS TIME 


meoure 24, Westerly Flight at 600. ft/sec. 
Longitude Rate Error [Rad/hour-meru] for Censtant 
Nomth GyrowDrire [1 meru]. 
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Figure 28. Stationary Case. 
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Figure 29. Stationary Case. Longitude Error [Rad/200ug] 
for Constant North Accelerometer Bias [200ug]. 
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Figure 43. Westerly Flight at 600 ft/sec. 
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Figure 48. Stationary Case. North Level Error [Rad/140prad] 
for Initial East Level Error [140urad]. 
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Figure 50. Stationary Case. North Level Error [Rad/140prad] 
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MEE eNDEX A 
heowevibie EAAMPLE : 
KALMAN FILTER APPLICATION TO A RADAR POSITION 
AIDED INERTIAL NAVIGATION SYSTEM 


4 


INTRODUCTION 

Pte apalicatiton of a Kalman filter tos a simolified radar 
position aided inertial navigation system was investigated 
jeeaerarst Step of our Study. Since the case apdears to be 
easy to understand difficult concepts and the results prove 
ene desizn expectations we present hereafter this simple 
case formulated according to the concepts and the outline of 
ref. 2, 

re [.N.S. system was “nodel@éd as white noise driving a 
1/ 8° plant. Radar measurements were assumed to be availaole 
and were similarly corrupted by white noise. 

The differential equations describing the system and the 
Kalman filter were numerically integrated to yield the 
response for a wide range of input conditions and system 
Memsee statistics. Particular attention was paid to 
conditions in which the noise statistics employed in tne 
filter were different from the statistics of the noise 
actually driving the system dynamics and measurements. 

For all cases considered, including those for which 


intentional mismatches in the noise statistics were 
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iitroduced, the filter was found to perform in an entirely 
Satisfactory manner. This is the filter reliably and quite 
accurately tracked the system's dynamics even at the 


presence of at times rather severe levels of noise. 


In the section to follow, tne theoretical development 
Satine Kalman filter equations will be presented. This 
develooment is based on that given in Chapter 6 of Maybeck 
meee eand according to exolanations given in class notes 
meee rror. Collins [Ref. 12]. 

Mexty, 42 discussion of simulation results will be given, 
in which the various cases considered are outlined, and the 
oerformance of the filter in each case is described. 

Finally an overall summary and conclusions regarding the 
OOServed performance of the filter over a wide range of test 


conditions, is presented. 


meeei. >. AIDED BY POSITION DATA 

Hopmeutme Proolem, the model of the I.N.S. is simply a 
double integration of noise-corrupted acceleration infor- 
mation, as depicted in Fig. 101. The noise w is a white 


Gaussian noise of zero mean and variance Kernel 
Bete Wweted)] = 96 (T) 


entering at the acceleration level, and it is meant to model 
the errors corrupting the I.N.S. accelerometer outputs 


(accelerometer biases and noise, platform misalignment, 
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etc.). The noise-corrupted acceleration is integrated once 
momeyield I.N.S.-indicated velocity (vi); and a second time 
to obtain inertially-indicated position Re 

Similarly a simple model for the radar or radio 
navigation aid is the true position Gr) corrupted by noise 
u, which is again white Gaussian with zero mean. 


Bie Cwo error state variables for this case are: 


eee y = F(t) - ret) 
‘ (A-1) 
St) = v,(t) - v(t) 


The measurement to be presented to the filter is the 


difference between the inertially indicated position and 
that measured by the radar or radio navigation aid. 


From Figure 96 we have: 


Be) 


r, (t) - r.(t) 


[r.(t) Sig Ges al ee [r,(t) Swen} = CA=2) 


6r(t) + u(t) 


This is a measurement of the error ér(t) corrupted by noise 
Oot) . 
To establish the state dynamics model for the error 


States, first let us consider the total states rs and v,. 
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cs 2 Ba oy (A-3) 
ae 0 0 V: 1 


The true position velocity and acceleration are related 


by: 


(A-4) 





| 0 1 ee | 0 | a, 
v. 0 0 IY | 

ms) L =A 
Subtracting (A-4) from (A-3) and using the error state 


@emimicions of (A-1) we find the desired relation as: 


$r 0 re ee | 0 Ww 
Sv 6 i 


(A-5) 
] 
Tae measurement model z can be expressed in terms of 


errors as: 


Zee) = [4 0] ér + u(t) = + UCt) 


ie 6 
|x 


Ov 


Since we would like to design a Kalman filter for this 


Situation we need to solve the RICATI equation as below: 


Pe Fp 4 pF) + G66) sepyi ac lupe nee) 
where 
p p 
P = m Ve and P = P 
: : 12 21 
21 22 


Pow 
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ECw(t)w(t+t)] = Q6(T) 


RS5(T) 


Bp t)uG@ts+Tt ) | 


solving for RICATI equation for our case we get: 


+ ° 2 
= = R 
ie 2? 15 eM 6 22 = 44! 427 ees 
e Ps zi 2 i 
wy 22 eee «P42 ZR 
For the steady state case where P = QO we get tne 


elements of covariance matrix in terms of Q, R and the ratio 


coy a which represents the natural frequency of the 
Sys cem ; 
p ' D gi/4 eet 
11 
leecones en he / 
Pio = Q R = P54 (A=7) 
” Bey ai / 4 
P55 = 24 R 


The Kalman filter equation is 


me > 


= Fist + GU + K(t) {z - Hx] (A~8) 


Wnich in terms of error quantities becomes: 


aA 


ér 0 1 ér , 
. = m + K ([z - 6r] (A-9) 
dV 0 0 SV 


ror 











where K PH ae 


Seis “We 1 

= n 
Roy Roo} | 0 
P../R 

Se (A-10) 
Pao/R 


ea Using the results of the RICATI equation solution we can 
Hie be 


Oo. UW 
K = = y where w. = (3) 


K (u,)* : 


44 trad/see] (A-11) 


From the above information we can draw the block diagram of 
eemicaiitan filter for this system as shown in Figure 10d. 
wae inictal cransient behavior of tne filter gains K 4 


and Ks depends on P but they are within a few percent of 


9? 
their steady state values (independent of ee, after wi t = 2, 
so a prediction of time to reach steady state would pe 
approximately 2/4, seconds [Ref. 2]. 

The filter can be put into either feedforward configura- 
tion or feedback configuration. Since for our study we use 
the feedback configuration we present here the outline and 
the results for this configuration. A block diagram of the 


system is presented in Figure 103 as depicted in Maybeck's 


work (Ref. 2]. This block diagram allows us to write the 
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system's equations whicn we will simulate numerically to 
achieve the system's performance. 
We define the outputs of the I.N.S. system corrected by 


feedback from the filter as follows: 


P(t) ri(t) - Sree.) 


(A~12) 


ec) °= v(t) = OveGt ) 


Which will be a very helpful mathematical tool since the 
most straightforward means of generating feedback 
implementations is to write the system and filter equations 
in terms of corrected system states. (For our case 
Semmecced 1|.N.S. states.) 

Then using the equations (A-3) and (A-9) together wita 
emeieroOn (A-3) We can write the matrix form of the system 


equations as: 


eee) —6r(t) 0 1 p(t) -8r(t) 0 fa, (t)+w( ty K ,(t) [2(t) -ér(t)] 


= + = 
vi(t)=sv(t)| 10 Olly, (t)-sv(t)} [1 Ko(t) 
. (A-13) 
and finally we get the simple form: 
P(t) 0 1) | F(t) O|fa(erew(ey] fx ,(t)] Cr (ty-F(t) 
: = + + 
v(t) Oe Merce) 1 K5(t) (A-14) 


In the next section the programming and simulation 


results of the system is pre'Sented. 
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III. COMPUTER SIMULATION AND RESULTS 

We Simulated the system for different input signals, 
different noise characteristics (zero mean Gaussian noise 
With different variances) to see the effect of the filter 
for error estimation. 

From the block diagram of the system in Figure 103 we 
can write the following set of equations wnicn we will use 


Pomeeeeresults by numerical computer simulation. 


x(1) 


= re = Ve 
oe) = Ve = a, 
mes) = pec a, 
K(4) = v5 =a, +N 
ioe) Pl Spm, - Per 
7 is I J fe 11 
Xx(6) = Pio = P55 - PayPoo/R (A~15) 
em 282-5 S50 = (P,5)°/R 
5 Seo 12 
x(8) = Sr = ay ~ K,¢2 ~ $7) 
x(9) ay = K5(2 - sr) 
mt 15.) = re = re - U 
xro ) = v = ve =. oF 


LOR 





may =r =r; - 6r 
x(18) = Ky = Paez & 

me 1 9oe = K, = P44/R 

mee) = Z RES A ae a. 
K(21) = Ww 

Mee) = U 


The above set of differential equations of the I.N.S. 
System and feedback Kalman filter were numerically 
Mieeetaved USing INT£G2 computer routine in conjunction with 
a routine (LNORM) for generating Gaussian distributed random 
numbers to represent the noise into the system. Typical 
simulation runs used an integration step size of 0.01 
meomas and a total run time of 36 seconds by which point 
the filter had easily achieved steady-state operation in 
Mest Cases. 

Shown on the next page is a run summary representing the 
various conditions that were tested. For each of six cases, 
the covariances of the measurement noise (R) and process 
noise (Q) are indicated. Note that in a number of cases, 
the noise statistics used in the filter were chosen to be 
different from those characterizing the input noise entered 


into the system. This intentional "mismatch" was done to 
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investigate filter performance under conditions where the 
true "real world" noise statistics are inadequately or 
poorly known. 

In particular it was desired to determine whether any 
ijseuanees of filter "divergence" could oe observed as a 
mst Of tne mismatch in system noise statistics. It is 
Meeworchy that for all conditions tested, tne filter 
performed in an entirely satisfactory manner with no 
evidence of divergence. 

Pemsnmould be noted here that in Table XI the noise 
covariances Q and R actually represent the statistics of 


Discrete Noise entering the system at the integration 


meceryal At = 0.01 seconds. aa cans: 
oe Alien 
awk | ie 
wnere ty, = Ka 
3p 
R = E(u, uy, } 


Bee it iS pointed out by Bryson and Ho [Ref. 13] the 
numerical integration is a discrete approximation to a 
continuous system whose noise processes have spectral 


densities given by 


Efw( t) wi tet) ] 
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The relation between Q and Q' and R and K! is according 


tos Bryson: 
Gt = Oat 
R' = Reat 


Also shown in Table XI for each case, are the filter 
natural frequency and tne steady-state values of tne Kaiman 
Bains . 

meortel discussion will now be given of the results for 
@aen of the six cases. Detailed plots of the variables of 
interest for each case are attached and will be referred to 
in the subsequent discussion. 

i Case | 

Por tenis case we used R = 10,000 and Q = 1 for 
the filter. The actual noise however is mismatched witn 
Ry = 100 and QO. = 1 and thus the filter assumes tne 
measurement noise of the radar position data considerably 
higher than the case is actually. Shown in tne attached 
Smets On Figures 104 and 105 iS the type of noise actually 
entered into the system using a Gaussian random number 
generator. Also shown are the histories of the Kalman 
filter gains K, and K, versus time. The performance of the 
filter for this case is outstanding as evidenced by the two 
plots for Case I in Figures 108 and 109. Here the estimated 


position out of the filter coinsides with the true position 
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denoting that the filter tracks the system extremely well. 
Among the other attached plots, Figure 112 presents the 
noise corrupted radar position in avery imposing way. 
2. Case II 
This case represents one in which the filter and 
external noise are "tuned" so that the same noise statistics 
SeemecmblOoyec with R = 100 and Q = 25. Again tne Kalman 
gains are plotted indicating the time of steady-state 
Pee toton in Figure 114 and 115. As it is depicted from 
Figures 116, 117 and 118 the Kalman filter rapidly 
"locks-on" to the true position and velocity and accurately 
tracks the system thereafter. 
ee «6Case IIT 
In this case the filter and external noise are 
meided" With R = 100 and Q = 1. The System's initial 
conditions now include a 10 Ree constant acceleration 
and it was desired to see how well the Kalman filter kept up 
with the changing input. Once again the performance of the 
filter in accurately tracking the system is excellent. fThis 
San De werified looking at Figures 124 and 125 and 126 and 
127 respectively where we can see the coinsidence of the 
true and estimated position and velocity. 
4. Case IV 
Mom this run the filter @nd external noiSe are again 


meumed". bUL With increased statistics of R = 400 and Q = 50. 
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The attached set of plots in figures 131 through 138 present 
the system and the filter operation proving the accurate and 
Satisfactory tracking of the system 
5. Case V 
Now the filter perceives the radar measurement noise 
meme nigher than it actwally is. The statistics used for 
meme, Sase wereeR = 400 and Q = 50 for the filter while for 
the external noise we used R, = 50 ane Q, =3505. eine 
reliability and the accuracy of the system is again depicted 
in the attached plots for Case V in Figures 139 through 146. 
6. Case VI 
In the last case considered the statistics of the 
random process noise exciting the I.N.S. accelerometers was 
mismatched with that assumed in the filter. Here we used 
2. = 50 and Q = 10. The radar measurement noise &, = R = 
400 was assumed the same. The set of plots in Fizures 147 
througn 154 indicate very good performance of the filter 
despite the intentional mismatch introduced for the system 


Gravwang noise. 


ive CONCLUSIONS 

Following the development of Reference 2, simplified 
equations characterizing the Kalman filter were derived and 
numerically integrated to yield the filter response to a 
wide range of input conditions and system noise statistics. 


Particular attention was paid to conditions in which the 
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noise statistics employed in the filter differed from the 
Statistics of the noise records actually driving the system 
dynamics and measurements. 

For all cases considered including those for which 
intentional mismatches in the noise statistics were 
introduced, the filter was found to perform in an entirely 
Satisfactory and reliable manner. By that is meant tnat tne 
filter very accurately tracked the system dynamics even in 


iS S2eno.se. 


(vp 


tne presence of at times ratner sever lev 

eemination of typical time histories for the variables 
of interest, snowed tnat the filter Kalman gains K, and K5 
rapidly settled to their theoretical steady state values 
Witnin a time snort compared to the average run time. fTnis 
WaS accompanied oy tne filter range and velocity estimates 
rapidly locking on to the true system position and velocity 
and accurately tracking it thereafter. 

It is concluded then that the Kalman filter confizgura- 
tion discussed nere above performed extremely well over the 


range of conditions considered. 
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COMPUTER RUNS SUMMARY 








Poieee r True 
CASE R Q Re Q, On (Kiss Se oc 
2 [ JO op 1° 2 [ to 1° rad 
Ere | ate lig mace =e. sec 
sec sec 
I 10, 000 1 100 1 O02 100 0.141 Oma ze 
ian 100 25 1090 AS 0.707 ] Bias Ure 
ron | 100 1 100 1 0.316 0.447 0.100 
IV 400 50 400 50 0.595 Oe Q.354 
V 400 50 a0 50 Oo Om oe] 65354 
Vi 400 10 400 50 0.398 Ol Sie Ono 
Mieimat Conditions: 
POSition =O Le 
Welocity =—oOet &/ sec 
Acceleration = QO 
uu 
Pay =~ Poo = 10 ) Pay = Poy = ) 
. 1/4 
w = Natural frequency = [Q/R] 
R = Measurement noise covariance used in filter 
Q = Process noise covariance used in filter 
Ry = True meaSurement noise covariance 
Q, = True process noise covariance 
Oe. = Steady state gain K, = 2 %y 
(K,)ss = Steady state gain K, = Cw, | 


a 


‘For this came system aSsumed to have constant 


acceleration 10 ft/sec. 
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meoure 104. Normalized Input Noise Versus Time, 
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Figure 105. Normalized Measurement Noise Versus Time. 
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Peeme 106. Gase I, Kalman Filter Gain to Velocity. 
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Mamee 107. Case I. Kalman filter gain to Acceleration. 
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Figure 108. Case I. True Position Versus Time. 
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Figure 109, Case I. Predicted Position Versus Time. 


205 





008 





006 


* . . 
° ° : S 
* . . . 
. . : . 
5 > = 
+ « : = 
A EP -S  a e, 


OO 


002 





000 


000 001 002 003 QO04 


Peteeibe=!),00F+O! UNITS INCH. [hours] 
feaoecieee- Wee to! UNITS INCH. [ft/sec] 


AWSTAS 
RUN 2 Yor! VS | Pre 


Figure 110. Case I. Predicted Velocity Versus Time. 
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Figure 115. Case II. Kalman Filter Gain to Acceleration. 
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Figure 117. Case II. Predicted Position Versus Time. 
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Figure 118. Case Il. Predicted Velocity Versus Time. 
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Figure 119. Case II. I.N.S. Indicated Position Versus Time 
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Figure 120. Case II. Radar Indicated. Position Versus Time. 
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Figure 122. Case III. Kalman Filter Gain to VemOcieey 
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Figure 123. Case III. Kalman Filter Gain to Acceleration. 
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Figure 124. Case III. True Position Versus Time. 
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Figure 125. Case III. Predicted Position Versus Time. 
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Figure 126. Case III. True Velocity Versus Time. 
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Figure 127. Case III. Predicted Velocity Versus Time. 
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Figure 132. Case IV. Kalman Filter Gain to Acceleration. 





020 


015 


005 


000 





X-SCALE=1.00E+01 UNITS INCH. [hours] 
fees =5,00E+O2 UNITS INCH. I[#£t] 


AWSTHS 
RUN e R-TRUE VS TIME 


meure 135. Case 1V. True Position Versus Time. 


229 








Peer t@ooree 


BS SCHCOCS SH Smccccd 


sseeece 


#5044 0@Oe0 coe enee 


020 


seeccone 


sertereeneces 


O15 


° 
* 
see eeeneere 


eoreeoers 

















os seeeese CER ertroccse 


eneocctes 


sececenes 


Or eeeeore 





sor aneene 


eocccee 


eR Oeee teccorocamers 






Peeereere 


° 


eeeetee 


« eeseersons 


@ntencnee 


eneecoces 


tor emeere Coereres 


eueccocs 


"Poeeten=s eee 


+O sere 























~occommee= 


eer eere 
° 


seteeee Cer cescese 


wre esse eeres 


nsec ercesseeeeces 


an eeeeree 


se eeeee 


























Fee oem nee tororees 


On eeeerroes ecemecere 


atu eetas se ceweres 


Ceeerecoece 


serserssodeccereces 


Peeeeeeeererereeree ohoereene 


eoereener 


eeecetee 


eoee eres 


srere seeeeny 


eortooee 























Nee sseicisns RE Sher eee ee ot aN a eles oun 
— : : . ry ‘ : - 5 . + 
bed Ad + . . . . $ + 
. . Ls = e . 
. e e 
. >: ' . 
once os eee ereccoere: sseonenes Serereeere, +e see P oots ames 
: 5 
° : i : : 
. 2 . x . 
: Carcodoccrc. + Porcrcnecccssoscose eaecccece Coeetencces . eee 0 . ireeeteorereees 
it . . . . 
: : ° = : : . = 
* e . . . . . . . 
: ° 5 : : : 
: : : 2 Hy S 
ece ceerenee +0 see- eee eteccee-cee Peccceetrors Or cet coe eerete 










































































































































' Ge: Rey are AE RR eae fee 
Ww oe: 
ae : : eae : 
a : ) 2 | ; 
; 7 : 
: ; 
beat Oe ee : ene ene eye eee 
: 3 ? : 
: : : : ; 
: i : 
. ; : : : 
ae Ci *Reeeees + ember +e ROAR ent hr cerere . er ereneee oe ferteeeer+e ere ere "eOBreeecoetts 40 eee stereeee “ee * eeeettese . ~SOCCr Stee eess 
| : ; 
~ = = 4 - +4 > . Poretete ee oo 
f ae Lune a eee fees he be See || a ar re 
ee ; : er. 
f . : ; : 
Lae asin es ae Be Eek OE Ta aida SON ee 


000 


ore. E 
io 3 Gigli 


ie ele 
5, (ee 


O0e 


OR UN es 
Ora INES 


003 


INCH. 
Piven. 


[hours ] 
aie 


KAWOTHS 


RUN e@ pate | VS oe 


Case IV. Predicted Position Versus Time. 


Prowae 134. 


















ereccoce +O neeees 





Peeveroe Oneetecee 





OO ov cers eoeerenre 


ss9eeren teres 

























oeeececreccoees O1eereer fee. + mmer:coenve orer mess erecesece erree 
: : 
é : : 
: : : : 
: : . : : 
eeeeroee Or eee eer elecetens ster vee veereveurforenveeroare oer @ . ee reeer 


taneeees 








eeeeceees Cm cece eereoe a® 





ereecce Crete reeeereeeeeces 





Ore reeerenreeereees 











Prerr OT eeeee rr? Te 








ss entrece POPOO er Orn OOOO ROeH Hy Oy OOOOH E EH HOOT Od be 






























° : : : : : 
Py : : : : : 
. - : : : : 7 
Sh bd ek thd pel betedh Dede td seGeeree PeTeTYTTITeTTirTT rT ery t Tree tt setae Bee SOP OPEROSe FOE HEH Hs «tere0e 
: : : . $ : 
. . . e . ° 
. : : 
, OOOO eer renew reeeDeeeeeees veneer nO ge Coeberens Honor er eeercereser ss eSereerrr sete ee MATOS IT EPP Tee rT 
rt : : . . 
. bd - 
Hany: . 





° 
oor reer Peery Coreeversereeecers 












COCO O rene ee OO OOOO Gore rran Kener sr OOurereves Sr eeoeroerocetreriererrPoerees - 4s Coeree serene 





oredr torerse 















; bs 7 ! 
= ne oe eee ‘ae: | : Ls. : 
S “ : : : 


’ 
’ 


Tere Reyne ve seat ererOmbeeers. someone 













sOeetee- ores eeeees 










POPC re erereeUreeeseowosers © seteeee 200+ 00+ + cece ects oreeetees 











Cee rereleeee re eDere® SOOO be eenerere ree 














o* Pete ene Pocereres Ceedentes nsetece reece 












2 eee gee es He eae ete ee ceccoe 
















POO eee eres erecen ooer 





asOree: 





002 













OOo seer ser ee eee eoresceteens renmeOers. ceeeden bs te commerce n+cvetes seeeeeees 









POO eeOoer- es eerObnenseenseees Of6 «08 eeceeccef ee. -ceeteracorere ‘eo | 











‘ 
° 
reer OT i Dest eert Tester rir rec reat Pe rerrs COE iri ir rer i eriies Titi terre reer e 


000 001 O0e GO3 O04 


eeiegiewe=1.00E+O! UNITS DNCH. [hours] 
ieeoemee=-c.M0E*O! UNITS INCH. [ft/sec 


AWSTHS 
RUN e V-HAT VS TIME 


meeure 135. ase IV. Predicted Velocity Versus Time. 











PMO ORO ooo: ooeeeeeoe CMP ea rer ocevece-bes SO er Mbe er oeereees =eeees er ere rd cones 











eoccccece 





eeegees 200 tances eeeerees 


eeetoee 





eeeeetoes oeomsree nee ePrgarere eeeccvee 





008 





. . : : 
° . : . * 

° . ° 

. . ° . : 5 . 

. . . . 





eeoeceee Coeeeccee| oooe eeeeee eee 





Se eeecvemeore tos cmeses 





eoeccee 


saewre eoereee 


Peewee ee cose eee 








PTeTTT eee ee ee roveces 








soee- 





e 
e 
e 
ry 
ry 


Oneee 
see0-8 

eovecs 
eevee 














20 Gee ree ber eeretooe Comers Peg id @eesse-obe on ee ccerebondceeee eeereeee eooee eoeeccece 












: : K : : 
: : : a - s 
‘ 3 f 6 A ‘ A 
= = ° e ° . . . . 
Sescsus=seecsecres | -asusecsersiesesctacscrartses Senco (aoc Sees eccccceseescocses ects ccefocscecs Reraceereaciere soe==e] coccces PTY tree 
. . . ° . ° ° 

. . ° e ° Hs 
e e ° . ° . ° 
acoricare waescenecee weaeneees eraca bah Saoceesces ceeccfocsccocce B ROCCOCORMECEOLY OSS 
wo : : : : 
: : : : 
QS : : : . : > . . 

on] : : . 

5 : 7 : 6 
: s 5 ' : : H 5 : f 
: 2 2 ; 
: ; : : 
sevees ceotecgece- oe cecee Beeserent Bseteses Dosuseuents HOME acnd Banncee weoesal -<m 




















ry 
. * . 
. . . . 
. . 
sees see" 000 eee Pen ceee ne soe ons @oees cesee ence. sedune Pe ry sseeenegeseesess «= 
. . : , . 
. + a0 @c0erdoe + Oe er seoeeee-e- Pe ee |e eeeer eee wae ee "98 sfore se ee eece eee ee ee . ove ot se@-eer © ses e@rssses © 
° . ° 
. . rf . : ° . . . . . e . F ri 
. e ry Ps . . . . . ° . Py . 
° Py rs ry ° . ° . . . ° ° . . 
e . . ry ° ry . : ry 
Py ° : . . . ry ry ry . ° 
. =@eceeeese @-eeeens sseeeee eeesecoscfoceceese e@oeete rere ys tee oe OO ee «or soreree . 























eoteoe Peoeeeecers 












ee eeecece 22 0eeteecccvoe eeeeccoce eeeeete Os en ccccecees Seeeececce oo ceccee 











en Oar eee 





Sees. eee 








eeerceees @evesoces seoreseocsce 










° . 
° ° . 
° ° ° * 
. : ° : : 
: : ° : ° ° 
ry * . 2 : . 
* ° . . . . ° . 
: : . . . ° 
. <i eens sone Oe eetoe: ceases. eee eee rot re onmeeene 











eeeertne sseeeer se en etoeees eeecfoce. 22e0 + tee weohecceges cmeeeeeee coee-e 








secceecee see Ceeceber=-s0Gee « pices baa? + eeeeccceces ereehecerece ee seee 
. { : ° . . 
ee engecccees “eeeetes een eecceece= -e008 es eeeecelosove . eee eee « Peter crefooess connce - eer 








. 
. 





002 003 004 


feet elbe=1.00E+01 UNITS JWCH. [hours 
Soemee=2,00E+O01 UNITS INCH. [ft] 


AWSTAS 
RUN 3 B-1wo VS | 1M 


mrpure 136. Case IV. 7N., Os INdicatved ProSTteion versus 
Time. 











* : 
. : 
. ° 









































li ereeee tas eeeeeeeeleoreer Oars er eesions Ce cemeeesrereeetone. cages an + eeeee tere eee . erees ATns'< 9 9ien - swerocere 
: : : : : : : 
: : ; : : H . . 
. . : . 
SOOO OO Ott COFCO. TOPO MM EOE EET O H+ + H+ FOCOr OOO SEES EH OONS 00 00 COPS OO Ns 0000 000 00) + OE SEs Geet es cees + eeeees OO RRO + CHOSE, COE MULE + OOO. + O00 +Oee- TeTEETTOeTi reese Fie tiir i) i irk 
° : : ° ° : : 
: : : ° : . 
: : : ° : . ' : a = 
PPeeeeerirere reer eeee rr irerey Pry iret tees rir ser Tir reer eer eT eer rere erry (Teer ree) seccccsces sees anceees eter: Cor ee eer er eee rener pees serene COs eeuece 
: ° : ; : ' 4 ° : 
Fi H : . 
Orserecersectons o eee eeecees 4 ietare cees 




























Pree erry ty ne neeee Os ceerer 








OOOH Coenen et ooeer cont Ore on 





Oreeeeere +eereee 


Srrrerrererry 










teneccsoeeeen 
teen er seeren 











sec ensesuncogenttnsooee 






0000 nc cceeceecess ccee recess 


POO OO + OH oe HOES OOOH +s OOOOOO Deo eet ees HOOORH + COBH Or rir Sees OBoe oreeeeres eeeeeee «se eeeeeer 
. ry . 









oreo 





loossqmece soeere 





+eereees 





ses eeeeencenees 







OFe acensonn eo 1 Sceeeeed edtercescoccenns 







































: * ° : ° : : . ° . 
terres tee eeeranentoe see sta eeenreos FOOr dns oeerere seree ey Ory Pee Deer reer eee er Oa ” e sree ore 
. r : H ; : ‘ ry . 
* . . : : “ : : . 5 . 
: . = : . 
. ' . 
a t Fe ranes) 6 dieee s sees . eae Rises. “s/s o. unas oe eee seenee SS s su cee cs se . a5 sa ase see Oreerees 
- . } 
: : + : : > . | 
sone ‘ . teerns eeee +500 One eoenns 7 . . steers ° ceeoee ta sere Heewes 
panne sHeereees 6 . eoee . one es Goer . 800s oh nec cececes tecces ee sees a] veonccens ° See neseee sneererere 
CQ : : f : 
‘ . . : . : . 
° . . 
© : 
’ ‘ . 
+ ‘ 
. : : c ‘ 
. . : ‘ ‘ . . : : . . . 
ry . ‘ . ® : : ‘ . : ° . . . . e 
* O weeosertoss eeeertreorede > . SER OOPree eee eR ee eee COO ee re eo ate + 
* + : Py > . : : : 4 . 
: : : * * ; ‘ . + ° ‘ . : 
; . > : : : + . : . : ‘ ‘ 
; + : : : . . . : . ; : : ry 
; : . e ‘ : : . ‘ ° : * 
: ‘ . : ; : : ; . . . 
+@eer see e+e eens 200 sores Peer ee? Ceteeeey See soccer errs ceee 0@ eee toe ’ 
: . : : ° : . : : > 
. ° > : . : : . . . 











stee eeeee teeccee . coe eeeeroe eee ecre PCat eeteesoote teoree Pettitte Dd Aated ° 




















. . e : . 
PEO Bee cs sce scass (csiceee ee “OC Saiesleecaeee ene: Socreiasesestee ‘ sevoucistcsdecrecalones ate Bee Suevcl cdeccostemnenseenteseareecesesereeree =. ecatess 








oteve 
° 
. 


: : i 
000 OO! 002 003 O04 


eee eal OOE+O1 UNITS INCH. [hours ] 
ieeemee=>.00Et0e UNITS INCH. tee 


AWSTHS 
RUN 3 R-RADAR VS [TIME 


Figure 137. Case IV. Radar Indicated Position Versus 
Time. 





O15 


010 





X-SCALE=1.00E6+01 UNITS INCH. [hours] 
ifelerisa—59.00LtO00 UNITS INCH. [ft/sec] 


AWSTAS 
RUN 3 V=INS VS | ie 


Figure 138. Case IV. I.N.5S. Indicated Velocity Versus Time. 


234 






























































: b ° . " ry 
. Pf : . : 
: ° : : : 
: . ° ° . 
: Py : : 
. : : : i : 
weteterteseecegors rer Or SOP eas re Pe rboogereetere oe + commetones soeeseree 
4 : : : ° : : 
. : . : : : ry : : : 
: . > : : ; . : : . 
: : : : : . ‘ 
: . : : ° . . 
: : . : e : : : . 
. * : : : : : : . : 
cece etee= Oeeeess cee Poe ceceeecarcooters = e0eereees O00 00 coeeeeens eee eee ceecstssecoses eeeeeeeers 
: > : ° : * : : 
: > s : . : : : 
: . ° : : : : : : . 
° : : : : ° : 
. 3 . . . : . . 
. : : : : : : : 
: : : . : : ‘ : 
° orev ovcceseooes Ocercse ae Ceececareces rer er cenen- eee sees 
. ° * : 
: : : 5 : 
; : : : 
: . : . 
: : 
3° eeeeee eeeeeeren see cees ore c ee Oost eteneee 
: : 



















. . . ‘ 
. . ° ° . 
: . P . . . : 

. ° ° . e 
° : . : . . 4 . 
* . . ° . . . . 
. . . . . 4 . . 
. . ° : . . . . 
emactercoresses . Peron eesececs eereeotee eeeeccees eoocceceete eoeeeccees eoeeecenne Peeereetee 
: ° Py ° ° H 4 4 Py * ry . 
« . . : e « ° . . . . 
© . « ° : . . « * . 
° ° . . . « . e 
ry . . ° . . . . 
° . . . . . . . 
° . . . : ° . : . 
° * . . . e e . . = 
. . . « : 4 . 
. Coe etocteetere sOsneeseee Camere retecrere oF 06808 FeGhe Oe += shoes reeusereleaweres eorcetecesete OOo rereceteres 6 ewe toe stee 
ry : . : . * 
. = ° . . . . * . . . . 
. . ° . . PY ‘ . . 
. . ° . . : . ‘ . . 
. . ° . . . . . : 
° . . . ‘ . . 

° ° . e 








eeoeeeoee 





Cereoeens Fee eeoestesseres Sevesee Covceceee 





O cownceeceeeses 





eee cows co roeerenee 





aaeee 









: : : 
. ° : ry > : 
teeeeeee eteere ° eee reece Cescvccegeee Oo ceeccerss Oneecretroere oF0 eed ceees 
: : s : . : ° 
. : : . : ° 
—— . . = : : ° 
ry : : : 
fas) eee , 
* : . : . . : . . : : . 
: : : 3 : 3 : : ° 
. : : . 5 . : . . : ‘ 
: : : : : : . . : . . ° 
: : : : : F : 5 : 
. . : . : PY . : 
: . ‘ : : : . : : 
eeccerroes ee Pere ere seeteee sees-tectoceves © se sone seeeeeenee orreee Corer eneeenes 
. : : : ° : : : 
. . . : : : . : : . ‘ 
. : : : . - 
. . | ° . . 
. : . . . 
. 


© teen eeentes Sennneee 





eeretess « 


eeeeeveoee 





Cererecvers 





o 008 «© 





= reece rrceeneoese 

















e0eee oe 








Por eet eset ever eeee. ofe eoceccee ones coeteseerte eereccce cote Oocteonece Coereeescceeee CORO ee regtoce 
i=) : 





























. = 00eee cece o-s0000 

: - « e ° 
. . . . ° 

Py . * . ° 
e « : . . « 

ceeceetece neste . ere es000 eae eoetooce 
. : . . . ° . 
. = . . ’ . 
* = ry ° . . 
‘ e - : . ‘ : 
: . e e . * ° 
: . . > > : > ~ 
° . . ¢ . : 
> a Ceceteeees ete cvenae + 000 scoce-coeteces cotenraes 
: e . . ° ° 
: . : 


















3 SOT 00 | igs 
feeaee=!1,.00E+0! UNITS INCH. 


fem e—o.00ET00 UNITS INCH. 


AWSTHS 
RUN 


mre 39. 


A | 


Case V. 











Con eenee ornee nate 














































ene 


sc eeretecqueeos 





Cen uUNGnSebcaceggeasae= 








sanfeoces 











ef ecoceccce 





. 


Podeseo. oo 


ss08 + 2060-00 














th eeeeccoeeseercees 














ens. 








scene 

















ortet: me 





snate 








ene of 





[hours ] 


ft/sec] 


VS 


Kalman Filter Gain to Velocity. 





eee ee eoee 
. 
sowocereee 


eecwrece. 








ry 

seceee 

° 

r 

ry 

soeeee 

ry . 

° : 

: : 

° . 
coase : 












Geocteves 











eoee 





eeeee 





eo 











eee 

















ee eenceee 





eeoevceee 





eeercecee 


eeeecccos 





TIME 





see 


FOO ever eOereerOhonsooovoeer eoeeersoe 


008 


. 
e 





eeeeeee 





oe oes 


se etees 


oe @er ere 


006 


seteren an OF eee eerroarnes er eere td ee 








ere ees Peer Sh eee eer! Per rere yy) 














i 
. eee sere ParOre : |. erte 





004 


eeecee Pes cecece-cccceees 





002 











eco Breere eevee 





. 









600 


reieml. £ = 
eee Al Gee 


AWSTHS 
RUN I 


Peoere 140. Case V. 

















1 9GBE+O1 UNTTS With. 
eee O00 UNS Een. 


























































* ry ry . . - r : 5 
: : iS 3 : : : : : 
° : ° 3 : = 
: 5 : ry : : ‘ 
: : ‘ : : : . * H 
° : : : $ : : : 
. : ‘ ‘ . : : : 
oor ++ eeetawee Rees Sree “8 sheetoewese Cotes oe are eee. F Pee ee ereennteos 
SOOO eee es Peeeeeeren o oF earcerereeene seer tess met store eseeemee 
: : ~ _ ; 
. . e . ~ 
: : : ? : c 
ry . : : . 
COOMBES FOO SHOES + SOCBBEEOEEe OCCT OC SESEOEE +S COPS HH ++ Oe OORe +e we Pwer eh ere ePeOrererreerten weeeeere 
. . . e ° : 
: : : 
‘ : . . 
: ; ' : : . 
00s seeeer= . tees cece sees emeses 
rs = = 5 : . ° 
. : = = . : : 
: 5 : C : ‘ . : 
. : : 
: J Pe : ‘ > 
: . : : : : 
: : : : : 
R000 en Oho mereonres ++ Comm see enone erotes peeeererforsoces tee 
: ° 
: H : 
4 : : 
: . : : 
: : ; : . ° : 
‘ : . : : 
: : : i ‘ : 
eereooee coe eeeees dooce : Meer rer <i) O00 eee ees ss ereeee rehepecrovener cere sae eeere 
: : ; : . : f : : 
. : : : : : : 
a oeeeeres eoreee eeese Orees ee ereeeers tOntee eee aeeece Ce ee 
: . ; : : : 
ees . ° : oeeroee oemreedors or enerersene ee eeoeeee 
: ‘ : . : : : 
: : : ‘ : 5 
: > . : : 5 
‘ 
: 5 : ° ° 
: 
‘ : 
weete- eens Peemcetn se rors eer erss see eet erent eeeeees stan teer Os aets COs er ferro eres s ser eemmer= SeReees Serer eeey COeee oncerce : core 
: : : : : 
PPOPeTTEPereTeL Ce reee er ereerd Creer ys Peeer rey TP erereer i iter ir ere ee eer eed Cree eecensststecccs Peere ey eer oe ’ 
: : 4 . 
seeee 0+ C0ecce coe, anene se Creeeee : eee aeons seee oeeseonall tence eeserseen nee = oaesee 
Ore toe =. Oren + OCe rs Or Ore Ore teen Ora terete Ore ee He eOreee Pee ees Pee eee Ie Oe eee ee ee ee wee Hee OOOF Oss Cor eerseOeee 





eeeere eee eee 





woes eeersevovosees 








rere r rity | eee 


ooo 











te 





° 


Perret) Peter eres 


swmecccoe 












: : 
. . . . ce 
- . : ° : : . 
= . . . 
FOO en KneePeoe reheeeeeaseees seeee: ss er ereeetecerse sae eooes cease seecce ocee 
° ° 
. . . . . P4 
- seeeeeee Pore +e oon nee eepes 
ore Seene ee Poets cers cor ss eeootes sees aH es eee eo eee® 





weeeec cee ceecee 


[hours ] 


at/ (sec) | 


i ae oo BS cs 


alman Filter Gain to Acceleration. 





corerters reeeeeees seceeset olor rameves vremser Cerrteers ceee 


sO 00e er enn 


ereeeerre eeeceeee 


OOOO e cern or aeeces Oeeerrrece 





eeeeecere 





errr tnd Pe Td oncceees Oeeeeeees Soeense 


we aOneeOnacacccen 





020 








en eetooer O0ers aeeroeeee soeporrre eee eecceceereeee= 


asses ceenes: 
at nterescee 


ry 


et eeseeoee 


eeeeccee eoreeeeen 





eo ereeceres 





© retoces 





aaeeeee 


Sere ctoeeer env cevece o pease. 


eteoeraer atoceeserenne htoters 








015 


























: 5 : : = ~ = 
. : . : A 
. . . : : 
: . . ° . : 
ereee PORCH OHHH Gere OUT eee eH OOO Gerretse SOR etter eens one =Oreteooerires « One - 00OGes ae vera siooeete e 
. * : : : : : : 
’ ° . ’ . . 
: : . ' = . : ‘ 
‘ : : : : M : ' . 
: 4 ' ° . H 
: . 
ooececcece sOer eres seece veneer eoerr 9 0eeerer oreo resee- ereveereedere veeeeeer oy veeere + eevervoees sees a 
‘ : 
= =*8@@r ceeeverce © Fee Ore eOere tere oge ere wee ee =. Seer reat ee « . Sete eee ta ee er erer © ate Hee ORereetres Racee Stak ah! <8 
. . . : -! . . 
° . . . : : . ’ 
: everves Foner -Orreteeererers COOre cece stecass cts ne reee st eecer: Or eeseeees reer eoeece poe «2 vevereeescveesvese ¢ : ¢ sees creas sasege 
(es) . 4 4 ° . : ° ° 
: : ri : : : ‘ : 
= : ° ~ : : : : : : 
=) : 









Pere 





eecceteerer 


















: : ° 
. : : : : 
: : : : 
: : . ° : 
° : : : : 
anmbetevestee: © O00 geessene ecveeeee seer eeeces Sone: c0ees- cee 
ry : : : : = 
: . : : * 
° $ : : : 
: ° : : 2 
: : ® : $ 
: : . : 
: ° . 






Cocees creer eeee 





seegeee ececeoce 








sotecccee 


OO cergeeerss cere etee 








eOcecrscereore 


sus eeeeeda-sen 
















orencusees 


= Oreebeoegses 
e 


005 





veeeer eee 








Scosece+soos . eoomece 


eeeces cence Perri 











eee 


eeccere teeetocce 





se nerete 





. . ) 
. : . 





eee retort em erGereeevcces orte+eee 





00+ Cees = qeesecece 

















eee TP ie tree Per eeee eeecerse:- teeeece-O00.8 Peecceet rocco ereerecee ereeeee. etre te0e+ teeeeeers eee 
* . ° 
: ° . 


Meaveree=1.00EtT01 UNTTS INCH. fhours] 
ieooeniee=5,00EF0C UNITS INCH. [£t] 


AWSTHS 
RUN e A='RUE VS Time 


[aome 141. Case V. True Position Versus Time. 













. 
eon eeeensece eecerece 













eoccmsete neee-enn 














° 
sn eeeeenenee Peeecefove.as eoeme eo ceccee eerces 
* 








seereesepere seecereelororesoess seme Rese retenccense Seen Creer rer Oreemrosecsoere S eseeceee 

. ‘ : ° 4 - : 

¢ : 3 4 . A 
° . ° . e - 
S : : : : : 
° ° . Py : : a 4 

: : : : : ° : : : : 

; : 






° 
BERR  CORH cece 


eeeeceoee coon CO ee areee 








someone eroeeeeee 





Manet oee ers ees ace 





ooncente eeceee 








sept enees see ertee 
Decersete 


On Reweeesoeeorees 


Coneheoes Pere re er iit 


wepeeeceseore POP ee eeeronces 
° 











° . é 
: : 
id 7 5 5 
° oI 
Oteeeeree Oo en Pesos + ee eeeewense 
ry : 
: ; 5 
sweccccenne ome. eC” 4 sece Ceweeetoee nae 5 








Peso eeeonee cestooce 





ee ontaee a eore-eeee emmeceraaas s0tete 














Oeeeeeeaces 























s0ee PresTereri ry ten eee teens coeeees eerrerery) oonens 
: . . < 
= : : . 
Reece sewers eM eneeee ° - fm 
° . Pere rier emeeeremeteenen: « 
: 4 : 
: ry : 












Rew ecerecce et ewenes 








eeeees ereerccene eenhoocce 





Prertrrer irr irts 








Pog eeeeeeteresere 





















seeneeene eetesee oes. «eceeeel. eeeeetenerse « 
* . . 
. : * ° ° 
ry . . rs 
. ry = : 
: . 5 : 
. iz 7 . 
. - ry 


earetete -eene 








* ofaeete-sccccemms ener eesere 








a eereennseses 





@avess00 





anes je teeee e0ees = 20eereers 








: : ; : 
° . = . 

+ # @enceee 6 eons + 0b 00 oteetoncs a oe eoee-Leocee o eeteves : : 
: . 4 





C 


1 


Moe niLe=1.00E+01 UNIGS 
ieee -5.00Et0e UNITS 


AWSTHS 
RUN e 


Bieure 142. Case V. 




































. 
ounnneese. oem ee cree uneeoes Recommecios . see . 
° : . 
e . . . 
. . . . 
e . . 
ry : : . 
. ° . . . 
eeeeeee Pere Seer @eeeee nee oe = ne Cem Heme an eeereese es seeees «semasens 
e : : : . 
° . . : : 
. : : . . . : 
eeeesereae eee ent eeeeres mone . | 











. 


Oo cwocees Poo ery eetenee 


POR Peeterereets 


Oe @eeeterera-s eeecece 


na teeeene 








One mOe eh ee eee erates cats aren 


Oe oetcocsetece 





+e eeee eoeees 


é 
. 


ee 








seen-eee 








eafeoeee econ os oeee see 





oD en eeweeeeresoces +90 on een ee tees ate ee 








a | 
| 


. © seneree Ceeet eee enseeeenssernae eee eee. eran coe ereree 
. ® . . 
. ° 








. 
eemmeneMocmetatecs stones . a | eeerocomares aeons 
4 . . 

e . ° * 

; ° : * 

. . . 


Meeseecresve 
° 


eotonanmececonene eoreeseenoe oeeeeenone 



















* * 
rs . * - 
Cotcece- 208 = 2 2ORageess eceetesess0 eee d semmneeraree ene enees 








eotecene ecceserce 

















a eoretenq oe seers eee 
ess eeResees seeere ore oeee sees 

. Ps 

oe. rrr rrr erry) =< ans et eres 


(GH. {hours ] 
PeGr. [ft] 


mM-HAl YS TIME 


Predicted Position Versus Time. 


























“. 


008 





a eenvcces 


eaeeoooee Secccouse 





otoccesee 












. 
. 
ry 
. 
° 
° 





Opesereee oteeee 





Poe een neeeeeree eters eeet 


° 
. 
° 
° 
. 





Mee note Pe geerecesececre® 
* 





006 














. 
* 5 
os Fe ecccee Serre er eelereceemes 
. . . 
. 
. oe - entrees ere somneee 
. Oreo enone . « Fy eo 
. 
. . 
OOo tceraadse eeecseeee Ty Peer rd 


ooee 


. . 

. . 
. 4 ° 
. . 


none sees 


eones se eeeecoe 





eoeercoes OOo ence 














~ See oe eevee oe seeeeee . 
oO : : 
= 





teecsece Beene ss 














ae ee 

: : | 
Ce eee ee | 
ok es : 
eee eee 
ae 





Kao Gall E 
T=SCAkE 


AWSTHS 
RUN 2 


Figure 143. Case V. 


‘ . 
° . ‘ 
Or eeneee eeete eeesece 
: ‘ ° 
. * ‘ : 
: . : * 
‘ . ° . 
Ootawstce . as eh etecee rr Creer) 
. . * 
. . : 
. * . 
. ° . 
. * . 
teeeeeeenn . eC oeeesesece . 
. ° . 
e . A 
. . 


eoeeeccee 


seeemerre 


eoeeroee 


Pertece 


Peseney 


ee ener eee 


Teese 

















Pet eenntecsccetescece® 


coe 





° 
. 

















Ot coc emecey eaereoess 
























caeve 





eeeeerees 





















Pamerecetooces 


. 
. 


eee ctoree On cetocce 





oeoree eorneeeen 





oe eeeeesres + ee eeeece 





se un erence seeeenee 











Pree eree tire itt tir rer res 





eocece amncocees 





ee ecveses econ Sercoceeee 





me eeu eeres emecoee 





° 
. 
. 
. 
. 
. 
. 
° 
. 


O eee eeetcecores 












































* 
: . ‘ . . ° 
eomooeee eooonecces eee ereeees Teer eer Perr . oceee Etorcces 
. ° ° : : . : : . : . ° 4 
. ° . : : ‘ : . . . ° 
. ° : : oY . : ° : . : : : 5 
. ° : : ° : : ° : . . ° 
: : . : : * : . : ° : : ‘ 
: : : ° . . ° e . : . . : ° 
: ° : ° ° ° r ° ° : . . > . 
. ° . . ° . ° : : ° . ° : . 
Sedweoevoercverese eeccresfeccovene eooreeevece Cees ceeveehe eee cveeeces ocr eger=oce Perree rer eee eee eerer ys Tiler rir) oes 
: * . . * ° ° ° * . ° : : 
. ° . . . : ° : . : : . : 
. « . : : : ‘ ° . . : . . 
: > : : : : ° ‘ ry . . 
. . . . * * ° . . : : 
. ° . . * . : * * . : 
seeeeetecccces ewveee erecrOrretes sereeeees eoeccece o-eeeeeee 0 0ee e+ eeeee Seevecet ence Puae 
. . . . 
. ° . . : . 
+ . . : ° 
. . . 
. : : 





Oe eeeerorore 






ee recretovcetes seetese 





























. : : 
° : ry . . : * . 
. t . . . . . . . ° : 
. . i . 
. . . . . . . 
PeOvere eter eerie) erect afooeese . Pee ereceesccore Ceorerececuhe eee POOe IEE SET eer ts Pee Pere eer rir ri) 
. . . . . : . . 5 : 
. : . . . . 
. . . . . . . 
. . . . « . 9 
: = Oe. a . soos eden en eee © 6 Fett este ceodedee seettenete . een oteee eReee Oem eeenetonne eeteces sere we retes es 
* 
t 
+ e008 + 5 a5 «|e . . . . atens Cersee . nab eer eneeeee PY et aeeae Soecccees o eeeee 
. ry 
° . 
. * . . 
“ . ‘ . . 
st eece Pere erry eer er cere: 2000: ceece a. eneee ecole See esacecee ee eeens eeerersces e0en eee 
5 : : * : : ‘ . : . 
. . a . : ‘ e . ° . . ° . 
. . . . . . . . : 
. . . . 
ry ry ° . ° 
= ° . . 
. . . 
= = 1 . 
. e . . . 





eee 


sectece 














PaGOESO! URIits MICH. 
2eCWewe! Utils INCH. 


eee 


















Orereeberverene 
° 


stcece Oeeeeenn- «= 






































er elec cecse PerirTi Ty sonseoes 
: : : : ° 
° : : : : : : 
oe- ce5s Or etee e200 e oe ces seeeeeees 7 ePerereeeree 
: : : : : : 
: ; : . 
. . . . ® 
a oo: 0] oes se reer bs ce reece see esseeres ercecesee eerceeseccore . me ereetecserese eneerese 
* ry : : : ; 
: 4 : : : : . 
: : : : : : 
: : : z : 5 
. 
@rash = Pecos eeePerese eceretes ontimee *eee Poet Perera oe 
* . : : : « : : : 
. : : : : : : : ; 
: : : : : : : : : 
: : : : . : : . 
- ; Fy 2 : 
ate eeceeroeenas eseen-e | soccceee : eteseecee Os seeeenes Te eeeesers Seeee Sere eters ceeens © 
. ; ? : : : : 
: : i . : : ° : c . = 
Cererer rent Perr ee . os cece os ceoces sinc ee eer eceweestee tes tener | 
ee ereeerrorsesesss * lee Soren seeeee tunctae 6 . © Cocee-soee OOOO RCO Hoe a Rene EH ene Hee FOOTE EOe FOnSe & | 
: 
4 
) ‘ 


[hours 
ft/sec] 


Vane VS |e 


Predicted Velocity Versus Time. 












° ° * * : . ° . : 
. . . . . 

. . ° : . 
. . . . . 
e e . 
© . ° . 
rf rs 





. 
eeeretercoeee 





Oe sere eecoocore weeeees waecee saeccceee|scoceces eeeeeee 


es eeeee eeeomere Pere Sid eee Tey 





















. 
ry 
4 
: 
. 
* 
. . : . ry . . . 
. . : > . 
. . ° . . 
. . ° . . 
"00 egeoee nn Oe anor seenets stems weeee . oom eeon ee oe oeeor mm ooeee 
. . ° . ° * 
. . . e ° . : Py 
. . Py ° Py e : . : : . 
. ° : . rs ° . . . 
. ° 
-ee ooo ww eese eee . . eee sees “Pe BO es ese eeuees seees C0eredeeeeees S000GeaR 
* ° ° . ° . . 
ry . . ° . * . . 
* . ; ° . . . ° . e 
° ° . : ° 
. ° 
* . = - 
ore oooe ene cece 2 eRe cor Peereneces <eeeeereaes PIUTITIL ITT Tee Pee) ee Pe 
° rs . . * ry 
: . ry . | . . : 





020 





eoeeernes 















eorcerece 







Perrys 































oo comes ce Oe Oooo ee ronoeeoees ere COO CC er coer ee eeenes 


Covererodmecgecs Pree IC eT eee Tee a) 





eee eeores 
° . 












O15 


: 4 : 




















seen nee . saneees sl onde ceee oo. wefe a be cee . . on eon) wa ee . 
: * : ry . 
. ry : rs : rs . 
rs ry ‘ : . : . . . 
* * r . ° . . 
: 5 7 : F ‘ : 5 : 5 
eeectocre eo s000 eee eee eeeree 6 1 0ee oeene . ove . oreo . Onin eee nan eneensreccegeteset soemeeers 
‘ . ° . ° : . . 
aeee Greaves seereete erenee eeeee- . . tore eooee eee oooe ee ere ee cenpereses ert Ti Pier Bee at | 
‘ . * . . : . - 
: e : : : : : (J . : . ° ' 
. . . . . * . i 
OOo OOH POE OOOH Renn HOEOE OOOH D: HOOOOEO Os Met OOeON eee ee Hebe bereense vodetes | Prove COCO oe or dios: HOOnH HH OO OOo eee Er Oee OOO ee reser neews eh eecsoeed FOO ee eRe Hr ee eaereus ur reee ens SOOHeuapanennen 00 000e- cseeceseseoce Os eesoree 
(= . * ° : ; . : ° : : . 
° : : . Ps { . * . ° 
‘ * . * : . : 
° . ° : : : . ° 
= ° : i: e rs | 































eotecee 
° : ; 
Cc . 
: = a : q i if 
: nas gece es . oe. eee poof : bevcereccehosecne eee ees nenned cos os a 
a ey ee: 4 | . : 
0 0 





X-SCALE=1.Q00E+O1 UNITS INCH. [hours] 
(ot Gee S- 805400 UNITS INCH. [ft] 


AWOTHS 
RUN 3 Pins V5 | Lere 
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Figure 145. Case V. Radar Indicated Position Versus Time. 


241 








eiegee— |. O0E+C! UNITS INCH. fhours) 
ipoiectea— | .O8ETOO UNITS NCH. (ft/sec) 


AWSTAS 
RUN 3 V-INS VS TIME 


Figure 146. Case V. I.N.S. Indicated Velocity Versus Time. 
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igure 147. Case VI. Kalman Filter Gain to Velocity. 
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eee 140. Case VI. Kalman Filter Gain to Acceleration. 
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Boerne. Case Vi. True Position Versus Time. 
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BPeure) 150. Case VI. Predicted Position Versus Time. 
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Figure 151. Case VI. Predicted Velocity Versus Time. 
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Pare 152.. Gase VI. I.N-S. Indicated Position Versus Time. 
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Figure 153. Case VI. Radar Indicated Position Versus Time. 
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Pepeec 2o4. Case VI. 1.N.S. Indicated Velocity Versus Time. 
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APPENDIX B 


SATELLITE GEOMETRY, VIEW AND RANGE ERRORS 


Tne range measurement equation will first be developed. 
Next a simple program has been formulated to verify the 
meeservVabltlity™ and "suitability" of at least four 


Sacvellites at any given time. 


PeeeekenGe MEASUREMENT EQUATION 

The range measuring process is characterized by a set of 
equations, called the range divergence equations, wnicn are 
generated by the user from a combination of I.N.S. and 
Satellite information. Tnis range meaSurement process 
involves tne comparisen of a measured value of range against 
a predicted value of range. 

The measured range to a satellite is determined by 
measuring the incremental phase shift between the 
Savellite’s clock and that of the control station wnich 
supports the user. These clocks were synchronized at an 
earlier time. The computed range on the other nand is 
obtained from satellite ephemeris data and user 1|.N.5. 
supplied position information. 

The fact is that both the measured and the computed 
range values contain in general errors; so by subtracting 


the computed range value from the measured one, tne 


aol 





different will contain only the associated errors. This 
difference is called "the range divergence." A Kalman 
filter can be constructed to estimate the errors and improve 
the accuracy of the raw range data if these errors can be 
modeled as the outputs of linear systems driven by white 
Gaussian noise [Ref. 8]. 

1. Range Divergence 

inte wcase Of a Single satellite will be considered, 

mamorder to avoid the notational inconvenience of using 
Sumerscripts or subscripts to keep track of which satellite 
is being referred to. The results are identical for any one 


of the 18 satellites and therefore very easily extended. 





i = User-Satellite position vector 
Cae Earth-User position vector 
re = Earth-Satellite position vector 


Figure 155. Range Vector Definition 


a2 





nieCmeecaiecm ccc O1eiMbcrese is the vector r from the user 
Pemeene Satelite. If iS explicitly related to tme two 
vectors r, and r. which are defined and illustrated in the 
above figure. From the geometry it follows that 


ies. - Is (B-1) 


= = a = f= ° -V eee 
oa) oa Ciara) CC ae | (B-2 ) 


The measured range to the satellite, r', is composed of two 


parts 
mee = Yr + -6r' (B-3 ) 


mere, fr is the true range and ér' is the error in tne 
mé@aSured range to the satellite. The computed range to tae 


Seeerlice, r", is in a similar way written: 
a= yf or (B=-4 ) 


where, r is again the true range and Sr" is the error in the 
value of the computed range. 

The quantity then, that is being observed, is the 
difference of these two range values and it is the called 


Mrange divergence," dr. 


oe = or'e= r" = ort —- 6ér" (B-5 ) 
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2. Errors in Measured Range 

To model the range meaSurement error, a Knowledge of 
the various error sources which are contained in the 
measurement is required and fitting these error sources with 
empirical data. The model used in our study is a simplified 
"erpsion of the one found in [Ref. 4] with additional 
information of [Ref. 5]. It is a linear combination of 
three components for each satellite measurement corrupted oy 
white Gaussian noise (w). Each of the separate components 
is a linear system which is driven by white Gaussian noise. 


The range measurement error is modeled by: 


geo reccun, — 61.) # W (B-0) 
waver s> 
6b = range bias 
C = the speed of the light 
61, = user clock phase error 
6T. = satellite clock phase error 
W = measurement noise 


The error in the range measurement due to ionosphere delay 
is assumed to be included in the satellite clock pnase/range 


error. This is a function of the elevation angle and on the 
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order of 15 feet as a good approximation. The bias tern, 
’b, in the above equation accounts for the minor effect of 
both speed of light bias and tropospheric delay uncertain- 
ties in each one of the four satellite range measurements. 
3. Errors in Computed Range 
The computed satellite position includes error which 


- 


depends on the ephemeris data errors, wnile Cie ein N. 


OP) 


Paeors account for the uncertainty in the user's position. 


So far we nave 


a - es a ér Cpe) 


i" = _ ~ srl (3-8) 


The error equation is ootained now since, 
ny? 


Cr art er" 


and by taking the differential of both sides we get 
or" é6rit = rite grit ae 6riter'tt 
or 


sr! = oa Grliisig'!) = (= a) oe (B-9) 


we can Casily notice that the quantity, ap ey of the right 


hand side is a unit vector from the user to the satellite. 


{ ? 6 . = : 
i ’ den = re’ ae cae (B-10) 


len 





and also that 


gt = Sr sete (B-11) 


Finally the computed error is written as 
de = Jae." ) (B-12) 


Without any significant accuracy loss, it is assumed tnavt 
tne earth-satellite range error, See 1S aoorow~emacs!] y “zero 
for the following logic sequence. Satellite oroital 
Parameters are updated by the ground tracking network on a 
periodic basis and relayed to the user along witn the range 
data. Tnis ephemeris data is quite accurate and any 
uncertainties in computed satellite range can be accounted 
Meieeoy increasing the satellite clock phase error [ref. 4]. 


iams the Compuved range error can be written 


sri ee dan e ae (B-13) 


The computation of the above equation requires values for 
the unit vector from the user to the satellite and also 
eurrent values for the north, east and azimuth I.N.S5. 


eeorcion error states 


sc," = [aN, ak, adj! 
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Since we are dealing with a stochastic process simulation 
the root-mean-squared (RMS) values of the covariance of the 
three position errors are used. 

The final form of the range divergence equation is 
obtained now by substitution of equations (B-6) and (B-13) 


into the general form equation (B-5) 


ne = 21 


S 


eui@een at least four satellites are required as observables 
tO correct for the three components of position and tne 
clock phase (or time difference), a minimum of four range 


divergence equations need to be solved simultaneously. 


EeeeeomeeLLITE OBSERYABILIIY 

In the following development of equations we will droop 
out the double prime (") for notational convenience. A 
Ziven satellite must be in-view by the user in order to 
obtain certain measurements. It is then required that the 
Satellite must be above some specified minimum angle of tne 
user's NMorizon to get a useful signal. This minimum angle 
depends upon the capabilities of the user-equipment and can 
Be vemeracterized as arbitrary. In our study the nominal 
Value of this angle was selected of ten degrees. This 
observability criterion together with the suitable selection 
of 18 satellites as the total number of satellites for 


global coverage, insures that regardless of the user's 
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Bosition, a sufficient and reasonable number of satellites 
will always be in-view, from which a "best set" of the 
required four satellites may be choSen. 

In the following a method for determining whether or not 


a satellite is observable is presented. 


, satellite 
las 
={s)- 

| 


{rR 


ie 
User =—s 


Se Local 


Homme Onl 


aren 
Center 


Figure 156. Observability-Criterion Geometry 


From the above figure and for the following calculations: 


Emin = minimum angle of elevation for useful signal 
O 

D aax a Emin 

ig = User-Satellite position vector 


Earth-Satellite position vector 
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Partn-Usier postion weetor 


earth to navigation transformation matrix 


© 
Tt) 


The quantity ae is most readily expressed in the navigation 


frame as 


eens ee 


| 
ny, 
il 
mg 
+ Cc 
“ 
i 
ae ee 
9) (S 
[ eee ee 
UW 
i 
UO 
~ 


where 
R = radius of Earth 


Weer eltitu@de of user 


and the superscript, n, denotes tne frame in wnicn tne 
vector is coordinated (navigation frame). 

Since the earth-satellite position vector in tne earth 
frame , a, is derived from the ground track latitude and 
longitude of the satellite in the orbit generator and 1s 


pea@uly available, the vector r from the user to the satel- 


lite coordinatized in the navigation frame is written as 


Pee = te Oe | 0 (B-16) 


259 





The unit vector along fa iomeven DY 


er? ee 2 0) ane @' 
eee eee es CCE (B-17) 


From the geometry we observe that the azimuth component of 
this unit vector is evaluated as the sine of the elevation 
angle, E, or the cosine of its complementary angle A. That 


LS 


: 0) ee see Os A (8-18) 


Bemear the observability criterion, if the unit vectors from 
the user to the satellite exoressed in the navigation frame 


eee Computed, oecomes 


he < Hi 
or 
cos A> cos Ae (B-19) 
on 
int = > ees Oe tne satellite is observable 
il ial < cos A , the satellite is not observable 
ce max 


Since we arbitrarily selected for our study the minimum 
elevation angle of ten degrees the above criterion requires 
the aZimuth component of this unit vector to be greater than 


the value of cos 80° = 0.174. 
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i > 0.174 ; oS Se (B-20) 
iD 


Total deployment consists of three rings or "constella- 
meee" of six satellites each. The satellite orbits are 
assumed to be planar and circular; in fact, the orbital 
speed and altitude and thus the orbital period of all satel- 
lites is assumed constant. Furthermore, since global cover- 
age is desired, the satellites on any of tne tnree rings are 
equally spaced; thus, the circular are between any two adja- 
cent satellites on a ring subtends a central angle of sixty 
degrees (6 x 60° = 360°). The satellite identification code 
used is a two-digit code, the first digit denoting the 
pewmerecular constellation-ring (1, 2 or 3) and the second 
digit indicating the particular satellite (1 through 6) 
emenmae toe six on tne denoted ring. As an example, satellite 
32 is tne second satellite on the third ring. 

iimorder to specify the orientation of any one satellite 
With respect to the Earth-fixed frame, three parameters are 
required. The most convenient parameters are the Euler 
angle, from which the direction cosines or unit vectors to 
the satellite may be determined. This process is explicitly 
described in [Ref. 11] and here we will use directly the 
result for the unit vector from Earth to satellite in Earth 


coordinates. 


(B-21) 


Zo)! 





where 


a Sin 2c Sines 


ils’ 
53 =e=(Sin Neos C +eos n Sin ¢€ cos £) (B-22) 
233 =ecouen Cos 2 = Sin yn SIN c cos € 


and the three Euler angles are &, n, ¢&. 

Mae initial conditions are the constant orbital para-~ 
meters of the satellite orbits are given in tne following 
two tables. Note that m refers to the mth satellite on tne 
designated n ring; for example, the entry of 2m represents 
the remaining five satellites of the second ring. The 
missing entries from the table, (--), are dependent upon tne 
initial values of tne Euler angles &€, n and ¢ which are 
specified. Finally the latitude and longitude values refer 


Pomeme ground track of the satellites. 


TABLE IX 


ORBITAL DESIGN CONSTANTS 


Orbital Period V2 Acurs 

Angle of inclination 63° (all three rings) 
Altitude 1), 00G3 1. Miles 
Separation arc-angle 60° (6 x 60° = 360°) 
Ring spacing arc-angle 2G ©3 x 120° = 360°) 
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TABLE X 


oeecL Lies evL ITAL CONDITIONS 


Satellite # Initial Latitude Initial Longitude Angle 5 


11 
Im 
21 
em 
5 
3m 


Now the 


vectors 


where 


ie 


0° On oe 
neg = -60(m-1) 
0° 120n (ap 9°? 
_ — -60(m-1) 
0° 24202 (OW) 0° 
fa ate -60(m-1) 


sequence of equations required to compute the Oh alate: 


for each of the 18 satellites is presented. 


B= 63 
Wweee2o-(ne tl). < wiet (B-23) 
me seeln=1) + Ct 


= Satellite designator (1 through 6) 
=erimemdesignacor (1, 2%0r 3) 
= rotational speed of earth = 15°/h = 1°/240 sec 
= orbital speed of the satellite 

eae 


Gene = = - 2.1 n.miles/sec 





Using the Euler angles the components of the unit 


: e 
vectors of the satellite-earth range, r. , are computed 


Ss 

meer. 10, il]. 
243 Simect es Sanne 
253 = —USiMmnECOS Clr aGOS nesin C cos. €&) (Be24) 
Bia3 Cos ees © =uSan n Simmetecos §& 


The ground track latitudes and longitudes are given by 


bab iGude ®& = arc-tan (a 4 2/ tae)" + co ) (B=25) 


Longitude A = arc-tan (-253/833) (B-26) 


The required components of the unit vector of the user- 
; n . 
Segemlite range, r , in navigation coordinates may now be 


computed. 


= r 
— os 
Q 0) ry 
n n ne _ o 
i‘ =r, - 0 = o Gees 0 = re (B-27) 
R R rp 
rc an) fe Ge) + te (B-28) 
=) = r"/r = ie oe ee 73 (B-29) 
a _ N E D 


The obServability-criterion requires 
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Marcos 80° = 0.174 (B-30) 
YD 


A sample output from the computer program for the observa- 
bility-criterion is included in the next pages listing the 
Satellites which are in-view at a particular time instant. 
The output table presents in seven columns the most 
i@je@enrtcant calculated data. Column 1 contains the satellite 
number according to the previously specified code. Columns 
eeeeeand 4 contain the nortn, east, and azimuth components 
of the unit vector under consideration. Columns 5 and 6 
Beeyercne ground track latitude and longitude for each 
satellite. Finally column 7 gives the observability result 
temovning with "O.K." the satellites which fulfill the 
Smm@erion and with "--" tnose satellites which do not 


Peer i) the eriterion. 
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APPENDIX C 


I.N.S. ERROR ANALYSIS COMPUTER PROGRAMS 
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